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ABSTRACT 


Two  theoretical  methods  and  the  development  of  a  guidance,  navigation,  and 
control  rapid  protoyping  system  address  the  issue  of  considering  the  integral  partici¬ 
pation  of  feedback  early  in  the  design  process.  The  first  method  addresses  the  problem 
of  sizing  the  horizontal  tail  on  a  statically  unstable  transport  aircraft.  Dynamic  con¬ 
straints,  which  implicitly  involve  the  flight  control  system,  may  prove  more  restrictive 
than  traditional  static  constraints.  Recovery  from  a  severe  angle  of  attack  excursion, 
or  penetration  of  a  vertical  wind-shear,  are  formulated  in  terms  of  the  solution  to 
a  convex  minimization  problem  utilizing  LMIs,  and  numerically  solved.  The  second 
method  addresses  the  problem  of  tracking  inertial  trajectories,  with  applications  for 
unmanned  air  vehicles.  This  problem  is  posed  and  solved  within  the  framework  of 
gain-scheduled  control  theory.  This  leads  to  a  new  technique  for  integrated  guidance 
and  control  systems,  with  guaranteed  performance  and  robustness  properties.  Finally, 
a  rapid  prototyping  system  for  the  flight  testing  of  guidance,  navigation,  and  control 
algorithms  for  unmanned  air  vehicles  is  designed.  The  system  affords  a  small  team  the 
ability  to  take  a  new  concept  in  guidance,  navigation,  and  control  from  initial  concep¬ 
tion  to  flight  test.  A  proof-of-concept  demonstration  of  the  system  is  detailed  when 
the  new  integrated  guidance  and  control  algorithm  previously  described  is  tested  in 
flight  on  an  unmanned  air  vehicle. 
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I. 


OVERVIEW 


A.  LAYOUT  OF  THE  CHAPTERS 

Methods  in  integrated  plant-controller  design  and  integrated  guidance-controller 
design  are  contained  in  three  chapters  and  two  appendices.  Applicable  supporting 
computer  code  is  explained  in  the  appendices.  The  organization  and  content  of  the 
body  of  the  work  is  as  follows. 

Chapter  II  addresses  the  problem  of  sizing  the  horizontal  tail  on  a  statically 
unstable  transport  aircraft.  A  brief  background  in  linear  matrix  inequalities  prepares 
the  reader  for  the  problem  formulation.  Recovery  from  a  severe  angle-of- attack  ex¬ 
cursion,  or  penetration  of  a  vertical  wind-shear,  is  formulated  in  terms  of  the  solution 
to  a  convex  minimization  problem,  and  numerically  solved.  The  effects  of  a  num¬ 
ber  of  parameters  in  the  aircraft  definition,  such  as  canards  and  flexible  motion,  are 
addressed. 

In  Chapter  III,  the  problem  of  unmanned  air  vehicles  tracking  inertial  trajec¬ 
tories  is  addressed.  The  concept  of  trimming  trajectories  is  defined,  and  the  tracking 
of  a  trimming  trajectory  is  converted  into  the  problem  of  driving  a  generalized  er¬ 
ror  vector  -  which  implicitly  includes  the  distance  to  the  trajectory  -  to  zero.  The 
linearization  of  the  generalized  error  dynamics  along  the  trajectory  is  shown  to  be 
time-invariant.  Using  these  results,  the  problem  of  trajectory  tracking  is  posed  and 
solved  within  the  framework  of  gain-scheduled  control  theory.  This  leads  to  a  new 
technique  for  integrated  guidance  and  control  system  design  for  unmanned  air  vehi¬ 
cles. 

The  development  of  a  rapid  prototyping  system  for  flight  testing  of  guidance, 
navigation,  and  control  algorithms  for  unmanned  air  vehicles  is  presented  in  Chapter 
IV.  The  system  affords  a  small  team  the  ability  to  take  a  new  concept  in  guidance, 
navigation,  and  control  from  simulation  to  flight  test.  A  proof-of- concept  flight  test 
demonstration  of  a  new  integrated  guidance  and  control  algorithm  is  detailed.  The 


1 


project  includes  a  parameter  identification  problem  for  an  unmanned  air  vehicle  at  the 
Naval  Postgraduate  School.  Controller  synthesis  and  implementation  follow,  based 
on  the  identified  model.  Finally,  the  system  is  used  to  test  the  theory  presented  in 
Chapter  III  in  flight. 


B.  CONTRIBUTION 

This  section  states  the  original  contribution  of  this  work. 

•  The  problem  of  sizing  a  horizontal  control  surface  for  a  statically  unstable 
transport  aircraft  is  addressed.  Closed-loop  performance  of  the  plant  and 
controller  in  response  to  certain  dynamic  constraints  is  used  to  define  a  design 
region  that  captures  the  integrated  nature  of  the  plant  definition  and  controller 
synthesis  process. 

•  A  numerical  tool  is  developed  that  determines  acceptable  combinations  of 
tail  volume,  center-of-gravity  location,  and  peak  actuator  rate  for  a  statically 
unstable  transport  aircraft  using  state-feedback,  or  output-feedback,  linear 
control  to  recover  from  a  severe  angle-of-attack  excursion,  or  vertical  wind- 
shear  penetration.  The  method  formulates  the  dynamic  constraint  as  a  convex 
optimization  problem,  and  uses  recently  developed  LMI  solvers  to  solve  the 
problem  numerically. 

•  Numerical  results  demonstrate  how  to  quantify  the  effect  of  the  following  in 
terms  of  their  influence  on  the  sizing  of  the  horizontal  control  surfaces. 

—  The  addition  of  a  canard  to  an  aircraft  definition. 

-  The  use  of  dynamic  output  versus  static,  state-feedback  linear  control. 

—  The  effect  of  simple,  symmetric  aeroelastic  motion. 

•  Work  on  implementing  nonlinear  gain-scheduled  controllers  has  been  extended 
to  trajectory  tracking  control  problems  for  unmanned  air  vehicles.  A  broad 
class  of  trimming  trajectories  is  defined,  and  a  technique  is  developed  that 
provides  independent  control  of  the  space  and  time  coordinates  along  trajec¬ 
tories  in  the  class.  Using  this  technique,  it  is  shown  that  the  performance  and 
robustness  of  the  linear  design  is  recovered  locally  by  the  nonlinear  plant  and 
gain-scheduled  controller. 

•  A  unified  system  for  the  synthesis,  simulation,  and  flight  testing  of  avionics 
algorithms  on  unmanned  air  vehicles  is  constructed.  The  system  is  used  to 
take  new  theory  in  integrated  guidance  and  control  from  conception  to  flight 
test. 


2 


II.  INTEGRATED  PLANT  CONTROLLER 

OPTIMIZATION 


A.  INTRODUCTION 

The  use  of  an  automatic  flight  augmentation  system  is  commonplace  on  a 
modern  aircraft.  The  benefits  of  its  use  may  include  such  things  as  the  remedy  of 
undesirable  flight  characteristics,  the  reduction  of  pilot  workload,  and  an  increase  in 
performance  and  fuel  efficiency.  Whether  required  for  safe  flight  or  not,  it  is  hard 
to  imagine  a  new  transport  aircraft  being  built  without  a  sophisticated  flight  aug¬ 
mentation  system.  In  fact,  the  next  generation  of  high-speed  civil  transport  (HSCT) 
aircraft  will  require  some  form  of  feedback  control  for  safety  of  flight  considerations, 
since  current  designs  have  an  unstable  short  period. 

Since  HSCT  will  require  some  form  of  automatic  flight  control  always  being 
active,  the  sizing  of  its  control  surfaces  is  no  simple  matter.  Traditionally,  static  con¬ 
straints  have  been  used  to  size  the  horizontal  tail.  For  a  given  tail  volume,  constraints 
are  calculated  that  limit  the  fore  and  aft  travel  of  the  center  of  gravity.  Constraints 
that  limit  the  forward  center-of-gravity  position  include  (1)  sufficient  nose-up  pitch 
acceleration  at  the  rotation  speed  (nose-wheel  lift  off),  and  (2)  sufficient  nose-up 
pitch  acceleration  at  the  approach  speed  in  the  landing  configuration  (go- around). 
Constraints  that  limit  aft  center-of-gravity  position  include  (1)  at  brake  release  with 
maximum  thrust,  sufficient  weight  on  the  nose  gear  (tip  back),  (2)  pitch-up  acceler¬ 
ation  at  the  rotation  speed  (nose- wheel  lift  off),  and  (3)  sufficient  nose-down  pitch 
acceleration  at  minimum  flying  speeds  [Ref.  26]. 

At  the  aft  center-of-gravity  locations  projected  for  the  approach  flight  condi¬ 
tion  of  the  HSCT,  dynamic  constraints  may  be  more  restrictive  than  static  constraints. 
The  need  to  include  dynamic  considerations  in  the  configuration  definition  process 
has  been  addressed  before.  References  [Ref.  5]  and  [Ref.  4]  describe  early  published 
work  by  Beaufrere  in  this  area,  largely  motivated  by  the  X-29  research  program.  In 
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[Ref.  41],  Schmidt  uses  the  system  sensitivity  function  to  describe  the  fundamental 
trade-off  that  exists  between  the  level  of  static  instability  that  can  be  controlled  and 
vehicle  flexibility.  Previous  (unpublished)  work  in  industry  has  used  time  domain 
analysis  to  determine  how  far  aft  (how  unstable)  the  center  of  gravity  could  be  before 
the  airplane  was  unrecoverable.  The  analysis  included  a  given  design  angle-of-attack 
disturbance,  and  given  rate  and  position  limits  of  the  pitch  control  effector. 

This  work  extends  the  work  of  [Ref.  26],  and  uses  a  numerical  technique  similar 
to  previous  work  in  [Ref.  33].  There  an  integrated  aircraft  controller  design  method¬ 
ology  using  LMIs  was  applied  to  the  control  power  sizing  for  an  F-14  aircraft.  The 
major  contribution  of  this  work  is  two  fold.  First,  the  tail  sizing  design  problem  is 
defined  in  terms  that  include  the  integral  participation  of  a  feedback  control  system. 
Since  the  degree  of  control  of  the  longitudinal  dynamics  depends  on  how  fast  and  far 
the  longitudinal  control  surface(s)  can  be  moved  by  the  control  actuator(s),  a  natural 
metric  that  captures  the  size  of  the  automatic  flight  control  system  is  the  maximum 
actuator  rate.  The  design  trade-off  naturally  includes  consideration  of  actuator  per¬ 
formance.  For  instance,  it  may  be  more  cost  effective  to  incorporate  faster,  generally 
larger  and  more  expensive,  actuators  rather  than  pay  the  drag  penalty  associated 
with  a  larger  horizontal  tail.  In  that  light,  we  introduce  the  following  definition. 

Tail  Sizing  Design  Space: 

The  Tail  Sizing  Design  Space  is  the  region  of  “acceptable”  combinations  of  tail 
volume  (Vh),_  center- of- gravity  station  {xc.g),  and  peak  actuator  rate  (umax). 

The  triplet  {VH,xc.g.,umax},  defines  an  aircraft  model  and  an  automatic  flight 
control  system.  The  model  is  obtained  through  the  linearization  of  the  nonlin¬ 
ear  dynamics  of  the  HSCT  at  an  equilibrium  point.  It  is  partially  defined  by 
the  specified  tail  volume  and  center-of -gravity  position.  The  automatic  flight 
control  system  is  characterized  by  the  specified  maximum  actuator  rate  in  the 
triplet.  By  “ acceptable ”  it  is  meant  that,  for  the  model  associated  with  the 
triplet  {VH,xc,g_,umax},  a  linear  controller  is  known  to  exist  that  1)  stabilizes 
the  plant,  2)  meets  prescribed  dynamic  performance  constraints,  and  3)  does 
not  exceed  the  maximum  actuator  rate  in  response  to  the  dynamic  constraint. 
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Second,  a  numerical  tool  is  developed  that  determines  the  Tail  Sizing  Design 
Space  for  a  given  HSCT  dynamic  model,  flight  condition,  and  dynamic  constraint. 
This  tool  is  termed  the  Tail  Sizing  Design  Tool ,  and  provides  the  capability  to  measure 
the  effect  of  adding  a  second  horizontal  control  surface  in  the  form  of  a  canard.  The 
Tail  Sizing  Design  Tool  also  provides  the  capability  to  measure  the  effect  of  simple, 
symmetric,  flexible  motion  of  the  vehicle.  Based  on  numerical  analysis  of  designs, 
conclusions  are  drawn  as  to  the  relative  effective  of  the  use  of  canards,  the  use  of 
static  versus  dynamic  controllers,  and  the  inclusion  of  aeroelastic  effects. 

1.  Example  of  a  Design  Space 

As  a  motivating  example,  consider  a  simple  case.  Let  a(s)  and  b(h)  be  two  in¬ 
dependent  variables  that  are  smooth  functions  of  s  and  h,  respectively.  Furthermore, 
assume  that  they  are  independent  of  time,  i.e.  =  0  and  =  0.  Let 

dx 

—  =  a(s)x(t)  +  b(h)u(t),  (II.  1) 

where  x,u  £  'R} .  Then,  equation  II.  1  describes  a  family  of  dynamic  systems. 

Evaluating  (II.l)  about  arbitrary  values  of  the  parameters  a(s)  and  b(h)  results  in 
the  LTI  systems 

x(t)  =  a(s0)x(t)  +  b(h0)u(t), 

*(0)  =  x0.  (II.2) 

It  is  desired  to  use  feedback  of  the  form 

«(0  =  -k(so,ho)x(t)  (II.3) 

to  stabilize  (II.2).  Lyapunov  stability  theory  states  that  this  is  equivalent  to  the 
existence  of  a  p  >  0  such  that 

2p{a(s 0)  -  b(h0)k(s0,  hQ )}  <  0.  (II.4) 

This  implies  that 

kiso’ho)  >  kS  (IL5> 
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guarantees  local  stability  of  (II.  1)  at  (s0,  h0).  This  places  a  lower  bound  on  k(s0 ,  h0). 

Assume  that  the  absolute  value  of  u(t)  is  constrained  to  be  less  than  some 
nominal  value,  umax.  For  this  simple  system,  the  maximum  value  of  \u(t)\  occurs  at 
t  —  0  and  is  equal  to 


'U'max  -  ^(sojM^oI-  (II.6) 

This  places  an  upper  bound  on  k(s0,h0), 

k(s0,h0 )  <  — .  (II.  7) 

Xo  ' 

The  two  limits,  (II. 5)  and  (II. 6),  are  shown  graphically  in  Figure  1. 


Region  of 
Acceptable  Gains 


u(max) 

xO 


Figure  1.  Range  of  Feedback  Gains 


k(s,  h ) 


If  the  boundaries,  are  allowed  to  approach  each  other,  the  region 

of  acceptable  feedback  gains  approaches  a  single  point  where 


d(s0)  U max 

b(h0 )  Xo 


(II.8) 


Suppose  a(s)  varies  linearly  from  a  minimal  value  of  0.1  to  a  maximum  value  of  1.0. 
Suppose  b(h )  varies  linearly  from  a  minimal  value  of  0.3  to  a  maximum  value  of  0.9.  A 
value  of  1  was  used  for  xo.  The  family  of  LTI  systems,  which  validate  the  relationship 
in  expression  II.8,  is  represented  by  the  curved  surface  shown  in  Figure  2. 

Below  the  surface,  the  LTI  systems  are  not  stabilizable  subject  to  the  stated 
constraint.  Above  the  surface,  multiple  controllers  exist  that  stabilize  a  given  system 
subject  to  the  stated  constraint.  If  the  maximum  acceptable  value  of  u(t)  is  included 
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Figure  2.  Family  of  LTI  systems  with  a  single  acceptable  gain. 

as  a  horizontal  plane,  the  Design  Space  for  this  simple  triplet,  {a,  ,  b  ,  umax},  consists 
of  the  region  above  the  surface  in  Figure  2  and  below  this  horizontal  plane.  This  is 
shown  in  Figure  3. 


0.3  0  a(s) 

b(s) 

Figure  3.  Example  of  a  Design  Space 
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The  intersection  of  the  two  surfaces  is  a  line  which  represents  limiting  combi¬ 
nations  of  a(s )  and  b(s )  for  a  fixed  umax  and  x0. 

The  chapter  begins  with  a  background  in  Linear  Matrix  Inequalities  sufficient 
to  formulate  the  general  problem  in  a  form  suitable  for  solution  numerically.  Next, 
the  Tail  Sizing  Design  Tool  is  developed  for  a  rigid-body  HSCT  model.  The  dynamic 
constraint  associated  with  the  problem  is  a  severe  angle-of-attack  disturbance.  Nu¬ 
merical  results  follow  based  on  an  application  of  the  Tail  Sizing  Design  Tool  to  an 
HSCT  model  representative  of  current  designs.  Then,  a  method  is  developed  that 
models  the  effects  of  simple,  symmetric,  flexible  motion  of  the  HSCT.  Numerical  re¬ 
sults  follow  based  on  applying  the  Tail  Sizing  Design  Tool  to  an  aeroelastic  HSCT 
model.  Comparisons  to  the  rigid-body  model  are  made.  Finally,  the  Tail  Sizing  De¬ 
sign  Tool  is  developed  for  a  rigid-body  HSCT  model  where  the  dynamic  constraint 
is  the  penetration  of  a  vertical  wind-shear.  The  chapter  ends  with  conclusions  and 
recommendations . 

B.  BACKGROUND  IN  LINEAR  MATRIX  INEQUALI¬ 
TIES 

It  is  usually  not  possible  to  express  the  solution  to  a  complex  problem  with 
multiple  constraints  analytically.  Progress  in  computational  power,  however,  make 
numerical  solutions  to  these  problems  attractive.  Efficient  convex  optimization  algo¬ 
rithms,  recently  made  available  from  The  Math  Works  [Ref.  17],  allow  problems  that 
can  be  formulated  in  terms  of  LMIs  to  be  solved  exactly. 

Two  major  results  in  LMI  theory  are  drawn  on  to  formulate  the  problem  of 
sizing  a  longitudinal  control  surface.  The  first  concept  is  that  of  an  invariant  ellipsoid. 

Consider  an  LTI  system: 

x  =  Fx, 

z  =  Gx ,  (II.9) 
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where  x  G  7£n,  z  €  'R?-  Let  P  >  0  and  define 

£  =  {(  e  nn :  CTPC  <  i}. 

Then  £  is  called  an  invariant  ellipsoid  associated  with  (II.9)  if,  for  every  trajectory  x 
satisfying  (II.9),  x(0)  €  £  implies  x(t)  is  in  £,  for  allt  >  0  [Ref.  6]. 

Let  £  be  an  invariant  ellipsoid  for  (II.9),  and  define  V(x)  =  xTPx.  From  the 
definition  of  £,  it  follows  that  V(x)  <  V(a:(0))  <  1,  and 

V(x)  =  xT{FTP  +  PF)x  <  0, 

=»  FTP  +  PF  <  0. 

On  the  other  hand,  suppose  3P  >  0  such  that  FTP  +  PF  <  0  and  x(0)TPa:(0)  <  1. 
Then,  for  x(t)  satisfying  (II.9),  we  obtain 

xT(FTP  +  PF)x  =:  V(x)  <  0. 

Integrating  both  sides  from  0  to  T  >  0  we  get 

V(x(T))-V(x(  0))  <  0, 

=»  V(x(T))  <  V(x(0))  <  1, 

for  any  T  >  0.  Therefore,  we  have  shown  that  £  is  an  invariant  ellipsoid  associated 
with  the  linear  system  (II.9)  if  and  only  if  FTP  +  PF  <  0. 

Next,  we  will  show  how  the  idea  of  invariant  ellipsoids  can  be  used  to  obtain 
bounds  on  the  peak  of  the  output  in  response  to  a  known  initial  condition.  Let  £  be 
an  invariant  ellipsoid  associated  with  the  linear  system  (II.9).  Then, 

IKOf  =  *(<)T*(*)  <  ma x(tGtG(  V<  >  0. 

Now, 

ma x(tGtG(  =  max  uT P~l/2GT GP~1/2u, 

<e£  |M|<i  ’ 

-  \\GP~1/2\\2, 

=  A  m^(P-1/2GTGP-1/2)^  (II<10) 


9 


where  Amax(.)  denotes  the  maximum  eigenvalue  of  the  argument.  Therefore,  an  upper 
bound  on  the  peak  of  ||^(t)||  in  response  to  a:(0)  can  be  found  as  a  square  root  of  the 
minimum  of  8  subject  to: 


8  -  A maX(P-1/2GTGP-^2)  >  0, 

(mi) 

a:(0)rPa:(0)  <  1, 

(11.12) 

FtP  +  PF  <  0. 

(11.13) 

Nonlinear  inequalities,  such  as  equation  11.27,  can  be  converted  to  LMI  form  using 
Schur  complements  [Ref.  22].  In  general,  any  nonlinear  inequality  of  the  form 


R  >  0,  Q  -  SR-'S7,  >  0, 
for  symmetric  Q  and  /?,  is  equivalent  to  the  LMI 


(11.14) 


Q  S 

ST  R 


>  0. 


(11.15) 


/  -SR-1 

’  Q 

s 

0  / 

ST 

R 

,(11.16) 


To  see  this,  consider  the  congruence  transformation, 

I  ol  [q-S,R-1St  0 

-R~tSt  I  OR 

where  the  block  diagonal  structure  makes  equivalence  to  expression  11.14  obvious. 
Using  Schur  complements  on  expression  11.27  yields, 

8-  \max(P-1/2GTGP-1/2)  >  0 
81  -  P-1/2GTGP~1/2  >0  ^ 

\  I  0  ]  \  6  oMl  ol 

>  0 


8  GP-1'2 

I  0 

8 

G 

I  0 

P-1/2QT  j 

0  p-1/ 2 

GT 

P 

0  p-1! 2 

8  G 
GT  P 


>0  4=^ 


P  Gt 
G  8 


>0. 


In  summary,  the  square  root  of  a  solution  to  the  following  optimization  problem: 
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min  6 


subject  to 


P  G T 
G  6 
x(0)T  Px(0) 

FTP  +  PF 
P 


>  0, 

<  1, 
<  0, 
>  0, 


(11.17) 

(11.18) 

(11.19) 

(11.20) 


provides  an  upper  bound  on  the  peak  of  ||z(f)||  for  the  system  (II.9)  in  response  to 
the  initial  condition  x(0). 

The  second  concept  used  is  that  of  an  LMI  region.  In  their  recent  work, 
Gahinet  and  Chilali  [Ref.  7]  introduce  the  concept  of  an  LMI  region,  and  have  shown 
that  such  regions  can  be  characterized  by  LMIs.  LMI  regions  include  sectors,  disks, 
conic  sectors,  strips,  as  well  as  the  intersection  of  any  of  these.  For  our  purposes,  the 
intersection  of  just  two  regions  will  suffice.  The  first  region  is  a  conic  sector  centered 
at  the  origin  with  half  inner  angle  <j>.  The  second  region  is  the  left  half-plane  with  its 
right  boundary  at  — /?.  The  intersection  of  these  regions  is  shown  as  the  region  C  in 
Figure  4. 
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The  eigenvalues  of  the  system  described  by  equation  II.9  lie  in  the  region  C, 
if  and  only  if  there  exists  a  positive  definite  matrix  P,  such  that 


sin  <j)(FTP  +  PF)  cos  4>(-PF  +  FtP)  0 

cos  <f>(PF  -  FTP )  sin  4>(FTP  +  PF)  0 

0  0  FTP  +  PF  +  P2/3 


<  0.  (11.21) 


1.  State  Feedback  Synthesis  LMIs 

A  feedback  interconnection  of  an  LTI  system  and  state-feedback  controller  is 


x  =  [A  +  BK]x 
z  =  [C  +  DK]x, 


(11.22) 


x  =  Ax  +  Bu 
<  z  =  Cx  +  Du  =  ^ 
u  —  Kx 

where  x  G  7Zn,  u  €  z  G  1ZP.  Substitution  into  the  previous  invariant  ellipsoid 
and  pole  placement  region  matrix  inequalities  result  in: 


mill  Zmax 

subject  to 


(C  +  DK)1 


(C  +  DK) 


>  0, 

x(0)J  Px(0)  <  0, 


max 

\T, 


(sin  <t>)(ATP  +  KTBTP  +  PA  +  PBK)  (cos  <p)(-PA  -  PBK  +  AT P  +  KT BT P) 
(cos  <t>)(PA  +  PBK  -  ATP-KTBTP)  (sin  <p)(AT P  +  KT BT P  +  PA  +  PBK)  . 
0  0 

0 

0 

AtP  +  KtBtP  +  PA  +  PBK  +  P2/J 


<  o, 


P  >  0.  (11.23) 


The  above  matrix  inequalities  are  no  longer  affine  in  the  unknown  parameters, 
since  the  state-feedback  controller,  K ,  and  positive  definite  matrix,  P,  appear  as 
multiplicative  terms.  Since  P  is  positive  definite,  let  Y  =  P-1 .  Perform  the  following 
congruence  transformations,  and  perform  the  substitution  of  variables,  W  =  KY. 
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P  (C  +  DI<)T 
(C  +  DK )  z2max 


y  o 

P  (C  +  DKf  ' 

0  I 

K  *Lr 

Y  ((C  +  DK)Y)T 
{C  +  DK)Y  zlax 

Y  ( CY  +  DW)T 

(CY  +  DW)  z2max 


>  0<s> 

>  o  ^ 

> 

>  0. 


(11.24) 


Y  0 
0  Y 
0  0 


(sin  <f>)(ATP  +  KTBTP  +  PA  +  PBK ) 
(cos  <j>)(PA  +  PBK  -  ATP  -  ICT BT P) 
0 


(cos  <£)(  ~~P A  -  PBK  +  ATP  +  KTBTP ) 

(sin  4>)(AT  P  +  JCT£TP+  PA+  PBK)  ... 
0 


0 
0 

ATP  •+  KTBTP  +  PA  +  PBK  +  P2P 

(sin  <t>){Y AT  +  WTBT  +  47+  BW)  (cos  <}>)(- AY  -  BW  +  YAT  -+  WT BT ) 

(cos  <t>)(  AY  +  BW -YAT  -WT BT)  (sin  <t>)(Y AT  +  WT BT  +  AY  +  BW)  ... 

0  0 


Y  0  0 
o  y  o 
o  o  y 


y>iT  +  wtbt  +  4y  +  BW  +  y2/3 


<  0^ 


<  0. 

(11.25) 


Using  Schur  complements: 


a:(0)rPx(0)  <  1  4=^ 


a:(0)ry_1a:(0) 
1  x(0)T 

x(0)  F 


<  1  <=*► 

>  o. 


(11.26) 


Once  again,  the  expressions  11.24,  11.25,  11.26  constitute  an  LMI  in  the  un¬ 
known  matrix  variables,  W  and  Y.  Suppose  3  Y  >  0  and  W  such  that  they  validate 
expressions  11.24, 11.25,  11.26.  Then,  K  =  W1  is  the  state-feedback  controller  that 
maintains  ||z||  <  zmax  in  response  to  the  initial  condition  x(0 ),Vt  >  0. 
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2.  Output  Feedback  Synthesis  LMIs 

A  feedback  interconnection  of  an  LTI  system  and  strictly  proper,  output- 
feedback  controller  is 


x  =  Ax  +  Bu 
y  =Cx 
z  =  Czx  +  Dzu 
xk  =  Akxk  +  Bky 
u  —  Ckxk 


=  < 


V  = 


z  = 


A  BCk 
BkC  Ak 
Cz  DzDk 


(11.27) 


where  x  €  1Zn,xk  E  W1,  u  €  7lm,  z  €  1lp,  y  EW,  rj  €  ll2n,  and 
where  r/T  =  [xT  xk].  The  initial  condition  is  rj( 0)T  =  7/J  =  [xq  x^o]. 

The  four  analysis  matrix  inequalities  based  on  using  the  concept  of  an  invariant 
ellipsoid  and  pole  placement  region  are  gathered  for  convenience. 


P  Gt 
G  81 


>  0, 
>  0, 


XqPx o  <  1, 


(11.28) 

(11.29) 

(11.30) 


(sin  <f>){FTP  +  PF)  (cos  <f>)(-PF  +  FTP)  0 

(cos  <t>)(PF  -  FTP )  (sin  </>)(FTP  +  PF)  0 

0  0  FtP  +  PF  +  P2/3 


<  0. 

(11.31) 


If  the  closed-loop  system  matrices  in  expression  11.27  were  substituted  into 
expressions  11.28,  11.29,  11.30,  and  11.31,  the  expressions  would  not  be  affine  in  the 
unknown  matrix  variables.  Similar  to  the  state-feedback  case,  the  key  is  to  find  a 
congruence  transformation  with  a  “linearizing”  effect  on  the  unknown  matrix  vari¬ 
ables.  In  a  recent  work  by  Scherer  and  Gahinet  [Ref.  8],  the  authors  prove  that  such 
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a  transformation  exists  for  the  output  feedback  case.  Consider  the  following  partition 
of  P  and  P_1, 


P 


p-i 


S  N 
NT  Q 

R  M 
MT  V 


(11.32) 

(11.33) 


Since  P  and  P  1  are  both  symmertic,  so  are  R  and  S.  From  the  identity 


p-ip 


we  can  infer 


I  0 
0  I 


R 

MT 


M 

V 


s 

N 

nt 

Q  . 

1 


RS  +  MNT  RN  +  MQ 
MTS  +  VNT  MTN  +  VQ 


RS  +  MNt  =  /, 


(11.34) 


or 


Also, 


and 


NMt  =  I- SR. 


R 

I 

MT 

0 

(11.35) 


(11.36) 


(11.37) 
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These  Identities  are  used  to  define  the  key  matrices  used  in  the  congruence  transfor¬ 
mation  as  follows: 


and 


Notice  that 


R  I 

- 1 

S 

_ i 

O 

- 1 

h 

o 

_ l 

=:  *2, 


I  s 

R  I 

p- 1 

— 

1 

o 

MT  0 

=:  Xx. 


x2x~x 


/  S 

- 1 

Co 

1 - 

o 

1 _ 

- 1 

fe; 

o 

_ i 

P. 


Using  Xi  and  X2,  consider  the  following  congruence  transformation: 


(11.38) 


(11.39) 


(11.40) 


i 

o 

i _ 

i _ 

O 

XjPXx  XjGT  ' 

0  I 

G  SI 

0  / 

GX1  SI 

Expanding  the  (1,1)  block  of  expression  11.41,  we  obtain 


(11.41) 


X?PX ! 


X'[X2X~1XU 


xl[  X2 , 
R  M 
I  0 


I  s 

0  NT 

R  I 
I  S 


(11.42) 
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Expanding  the  (2,1)  block  of  expression  11.41  for  the  general  case  of  output  feedback, 
we  obtain 


GXx 


DzCk 


R  I 
MT  0 


CzR  +  DzCkMT  Cz 


The  matrix  inequality  in  11.28  becomes 


(11.43) 


R  I  MCI  Dj  +  RTCJ 

I  S  CJ 

CZR  +  DzCkMT  Cz  ** 


>  0. 


After  a  congruence  transformation  with  X1,  the  LMI  in  (11.29)  becomes 


(11.44) 


R  I 
I  S 


>  o. 


(11.45) 


This  LMI  is  accounted  for  as  a  principle  sub-matrix  of  the  LMI  in  (11.44).  Schur 
complements  are  used  to  express  the  LMI  in  (11.30)  as 


1  vt 

Vo  P-1 


>  0. 


Assume  xko  =  0,  and  consider  the  following  congruence  transformation: 


(11.46) 


1  0 

’  1  vl  ' 

1  0 

1  vlx 2 

1 

frn  cn 
* 

o 

1 

o 

*0 

1 

M 

1 _ 

o 

to 

1 _ 

Xjr,0  XJP~'X2  _ 

1  VToX2 

Xjrjo  XlXx 


(H*47) 
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Expanding  the  (1,2)  block  of  equation  11.47  yields, 


T 

Vo 


I  S 
0  NT 


(11.48) 


After  the  appropriate  congruence  transformation,  and  substituting  (11.48)  into  (11.47), 
we  have 

1  Xq  XqS 

Xq  R  I 

STx0  I  S 

To  see  how  the  pole  placement  region  LMI  is  transformed,  look  at  the  trans¬ 
formation  of  the  (1,1)  block  of  equation  11.31. 


>  0. 


(11.49) 


FtP  +  PF  <  0 
P~1Ft  +  FP~ 1  <  0  4=4- 

XjP~1FTX2  +  XjFP~1X2  <  0.  (11.50) 

Since  P-1  =  XiX^1  and  P~T  =  X^Xf,  equation  11.50  becomes 


x?ftx2  +  xJfx1  <  0. 

For  output  feedback  synthesis 


F 


A  BCk 
BkC 


Substituting  (11.52)  into  the  first  term  in  (11.51)  results  in 


XT2FXx 


I  0 

A 

BCk' 

R  I 

S  N 

BkC 

Ak 

* 

O 

(11.51) 


(11.52) 
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A  BCk 

R  I 

SA  +  NBkC  SBCk  +  NAk 

MT  0 

AR+BCkMT  A 

SAR  +  NBkCR  +  SBCkMT  +  NAkMT  SA  +  NBkC 

(11.53) 


Define  the  change  of  variables, 

Ck  =  CkMT ,  (II.54) 

Bk  =  NBkC,  (11.55) 

Ak  =  SAR  +  NBkCR+SBCkMT  +  NAkMT,  (11.56) 


and  equation  11.53  is  rewritten  as 


AR  BCk  A 
Ak  S  A  +  Bk 


(11.57) 


Each  term  in  the  pole  placement  LMI  is  transformed  in  a  similar  fashion.  This 
results  in 


sin<^(ET  +  S)  cos</>(-E  +  ET)  0 

cos  <f>(E  —  ST)  sin  <f>(  ET  +  5)  0 


0 


Er  +  S  + 


R  I 
I  S 


2/9 


<  0. 


(11.58) 


Notice  that  expressions  11.49,  11.45,  11.44,  and  11.58  are  affine  in  the  unknown 
matrix  variables  Ak,  Bk,  Ck,  R,  and  S.  Thus,  they  constitute  an  LMI.  Given 
Ak,  Bk,  Ck,  R ,  and  S  that  validate  expressions  11.49,  11.45,  11.44,  and  11.58,  the 
output-feedback  controller  is  reconstructed  as  follows.  First,  reconstruct  the  matrices 
M  and  N  via  a  singular  value  decomposition. 
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UY?Vt  =  I-RS , 

(11.59) 

AT1  =  EV, 

(11.60) 

M~T  =  t/E. 

(11.61) 

Form  the  controller 

by  inverting  the  change  of  variables  in  expressions 

11.55,  11.56, 

and  11.56  as 

Ak 

=  N~\Ak  -  SAPR  -  BkCpR  -  SBpCk)M~T , 

(11.62) 

Bk 

=  N-'Bk, 

(11.63) 

ck 

=  CkM~T. 

(11.64) 

C.  HIGH  ANGLE  OF  ATTACK  RECOVERY 

1.  Problem  Formulation  for  a  Rigid  Body  HSCT 

The  Plant  Controller  Optimization  (PCO)  problem  to  be  solved  in  this  section 
can  be  stated  as  follows: 

Let  an  HSCT  flight  condition  be  specified  by  the  aircraft’s  flight  speed,  altitude, 
and  flight  path  angle.  Furthermore,  let  a  certain  set  of  flying  quality  require¬ 
ments  exist  for  the  HSCT  at  that  flight  condition.  Let  the  dynamic  constraint 
be  defined  as  the  recovery  of  the  aircraft  from  a  high  angle- of-attack  excursion, 
while  not  exceeding  certain  peak  actuator  rate  and  actuator  amplitude  limits. 
Then,  for  a  range  of  horizontal  tail  volumes,  and  for  a  range  of  peak  actua¬ 
tor  rates,  determine  the  aft  center- of- gravity  limits  for  which  there  still  exists 
a  linear  feedback  controller  that  1)  stabilizes  the  plant,  2)  satisfies  the  flying 
quality  requirements ,  3)  satisfies  the  dynamic  constraint. 

Let  xcg  denote  the  center-of-gravity  location  as  a  fraction  of  the  reference 
chord,  and  let  x  denote  the  vector  of  HSCT  longitudinal  states.  Let  u  denote  the 
horizontal  tail  incidence  angle,  and  let  Vfj  denote  the  tail  volume.  Figure  5  provides 
a  description  of  the  tail  volume,  Vjj- 

This  representation  is  convenient  since,  for  one  flight  condition,  the  wing-body 
mean  aerodynamic  center  remains  constant.  Thus,  the  control  surface  volume  and 
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it 


Figure  5.  Definition  of  Vh- 


center  of  gravity  are  decoupled  in  terms  of  their  influence  on  the  vehicle’s  dynamics. 
The  longitudinal  dynamics  of  the  aircraft  can  be  expressed  by  the  following  system 
of  differential  equations: 


X  U,  XCg,  V#), 

z  =  H(x ,  u), 


(11.65) 


where  JF(.)  is  a  C1  function  of  x,  u,  xcg,  Vh ,  'H  is  a  C1  function  relating  x  and  z,  and 
z  =  [VT  7]t  defines  the  true  airspeed  (VT)  and  flight  path  angle  (7).  Let  x0,u0  denote 
the  trim  values  of  x  and  u  for  a  given  z0  and  center-of-gravity  location,  xcgp ,  i.e. 
3~{x 0,  Uo,xcgo,  Vjja )  =  0  and  W(xo,  Uo )  =  zq.  Here  the  vector  z  is  used  to  characterize 
the  flight  condition.  Later,  when  xcg  is  allowed  to  change,  the  trim  values,  x0  and  Uq. 
will  be  recomputed  for  given  values  of  xcgo,  z0  and  VHo.  Now,  linearizing  Q  about 
x0,  u0  yields  a  system  of  linear  differential  equations, 


6x  —  A(z0,xcgo,VH0)8x  +  B(z0,xcgo,  Vh0)6u,  (11.66) 
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where  8x  and  8u  denote  small  perturbations  in  x  and  u  about  Xo  and  u0,  respectively. 
In  the  numerical  analysis,  the  velocity  components  of  8x  were  normalized  by  the  trim 
value  of  the  true  airspeed. 

Let  the  actuator  dynamics  be  independent  of  (Z0, xcgo,  Vh0),  and  let  them  be 
given  by  the  set  of  differential  equations, 


8xa  —  Aa8xa  ~{“  Ba8u, 

8u  =  Ca8xa ,  (11.67) 

8u  =  Cr8xa  +  Dr8u , 

where  8u  denotes  the  actuator  amplitude  and  8u  denotes  the  actuator  rate.  Append¬ 
ing  the  actuator  dynamics  in  series  with  the  linearized  longitudinal  dynamics  results 
in  the  system: 


Gi  (z0,xcgo,VHo)  =  < 


8v  = 

8u  = 
8u  = 


where 


8vT  = 


A  BC a 
0  Aa 
0  Ca 
0  Cr 

8xT  8x ? 


8v  + 


0 

Ba 


8u 


8u 

8v  -f-  Dr8u , 


(11.68) 


(11.69) 


Flying  quality  requirements  are  typically  characterized  by  the  level  of  attention 
and  skill  required  of  the  pilot  to  control  the  aircraft.  They  are  grouped  in  three  levels. 
A  lower  level  corresponds  to  more  benign  flight  characteristics.  In  order  to  achieve 
certain  Level  II  flying  qualities  requirements,  the  eigenvalues  of  Gi  must  be  placed 
in  a  more  restrictive  region  in  the  left  half  plane.  Figure  6  shows  suggested  locations 
of  the  Category  B,  closed-loop  pole  locations  of  the  HSCT  short-perod  mode.  These 
locations  meet  Level  II  flying  quality  requirements  for  the  flight  condition  used  in  this 
study.  Notice,  these  locations  can  be  characterized  as  having  a  minimum  damping 
ratio  of  0.2  and  natural  frequency  of  0.2  radians  per  second.  This  suggests  that,  in 
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order  to  meet  Level  II  requirements  for  the  HSCT,  the  short-period  eigenvalues  of 
the  closed-loop  system  Gi  must  be  placed  in  the  region  in  the  complex  plane  given 
by  Figure  7. 


Figure  6.  Acceptable  Short  Period  Pole  Locations 
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2.  Canard  Configuration 

The  horizontal  tail  is  the  most  significant  control  effector  for  longitudinal  con¬ 
trol  of  the  aircraft.  It  is  not  uncommon,  however,  for  long,  slender  aircraft  designs 
to  include  canards  for  supplemental  longitudinal  control.  The  XB-70  and  B-1B  are 
two  examples.  Their  presence  is  usually  attributed  to  flying  quality  control  issues 
involving  the  flexible  nature  of  these  aircraft  [Ref.  1].  This  point  is  addressed  in  a 
subsequent  section  concerning  control  of  an  aeroelastic  aerodynamic  model.  To  lay 
the  ground  work  for  that  section,  and  as  a  baseline  point  of  comparison  for  a  rigid 
structure,  this  section  addresses  the  addition  of  a  longitudinal  control  effector  for¬ 
ward  of  the  wing.  The  effect  on  the  Tail  Sizing  Design  Space  is  explored  when  the 
feedback  control  system  is  free  to  utilize  both  control  surfaces,  in  order  to  recover 
from  angle-of-attack  excursions. 

The  revisions  to  the  nonlinear  equations  of  motion  required  to  account  for 
the  addition  of  the  canard  parallel  the  development  in  [Ref.  14].  When  these  non¬ 
linear  equations  of  motion  are  linearized  about  the  equilibrium  point  determined  by 
(zo,xcgo,VHo,VCo),  the  following  LTI  system  results, 


8x  =  A(z0,  xcgo,VHo,Vc0)8x  +  Bc(z0,  xcgo ,  VCo)8uc  +  Bh(z0 , xcgo ,  VHo)Suh ,  (11.70) 

where  uc  and  represent  movement  of  the  canard  and  horizontal  tail,  respectively, 
and  Vc0  is  the  canard  volume.  Actuator  dynamics  for  both  the  canard  and  horizontal 
tail  are  appended  to  the  linearized  longitudinal  dynamics  as  before.  The  actuator 
dynamics  are  given  by: 
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xac  v 

0  A„ 


6xJ  8x1 

ac  0>h 


8xa  -|- 
T 


Bac  0 

0  B„ , 


8uc  Cac8xaj 

8tlh  ^afl8xa^ 

8uc  —  CTc8xa  T  DTc8uc, 

8iih  B t^8x a  |  D-p^Sufi. 

This  results  in  the  following  system, 


(11.71) 


Qi  (zo,xcgo,VHo,VCo) 


where 


A  BcCac  BhCah  r- 

88  =  o  Aac  0  Su  + 

0  0  Aah  J 

8uc  =  0  Cac  0  8v 

foe  =  0  Crc  0  8v+  Drc  0 

8uh  =00  Cah  8v 

foh  =00  CTh  8is+  0  Drh 


8v  + 

Bn, 

0  1 

8uc 

0 

Bah\ 

_  8uh 

8v  —  $xT  8x1  8x1 

ac 


(11.72) 


The  initial  condition  is  defined  by  the  angle-of-attack  perturbation.  Let  the 
angle- of- at  tack  perturbation  be  given  as  q^;  then  the  initial  condition  is 

c  r  iT 

8vo  —  0  Vt  cos  x(a0)  0  0  0  0 

For  each  design  point,  Qi  (zo,xcg ,0,  Vj/0,  Vc0),  the  question  becomes,  is  the  set  of  feed¬ 
back  controllers  that  recover  the  aircraft  from  the  angle-of-attack  excursion,  while 
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maintaining  acceptable  flying  qualities,  and  without  saturating  the  actuator,  or  ex¬ 
ceeding  a  certain  actuator  rate,  empty? 

3.  Proposed  Numerical  Solution 

In  this  section,  we  make  the  conjecture  that  the  problem  at  hand  is  analogous 
to  the  example  presented  in  the  introductory  section.  The  center-of- gravity  location 
plays  the  role  of  the  parameter  influencing  the  stability  of  the  open-loop  plant.  The 
tail  volume  plays  the  role  of  the  parameter  influencing  how  controllable  the  plant  is 
from  the  input  where  feedback  is  to  be  applied.  It  is  shown  that  when  the  plant 
parameters  are  fixed,  the  problem  can  be  formulated  in  terms  of  an  LMI,  which  is 
affine  in  both  the  controller  parameters  and  actuator  limits.  Minimizing  the  actuator 
rate  limit  is  a  convex  optimization  problem  that  can  be  solved  exactly.  For  one  set  of 
plant  parameters,  let  the  result  of  the  process  be  characterized  by  the  final  values  of 
all  of  the  parameters.  Repeat  the  process  for  different  sets  of  values  of  the  plant  pa¬ 
rameters.  Then,  an  assumption  is  made  that  the  points  lie  on  a  smooth  hypersurface. 
If  the  grid  of  plant  parameters  is  sufficiently  fine,  the  shape  of  the  hypersurface  can 
be  discerned.  The  projection  of  the  hypersurface  into  the  three  dimensional  space 
spanned  by  tail  volume,  center-of-gravity  location,  and  actuator  rate  limit  defines  a 
surface  in  the  Tail  Sizing  Design  Space  that  is  extremely  useful  in  the  design  of  the 
aircraft. 

Let 


( Ql  (Zo,  % ego  1  VHo  •>  Vc<)  ) i  “V>h  max  ?  ^ hmax  5  ^ Cmax  t  5  vo)  = 

{W,Y  >0: 

Y  YT  [0  Crc  Of  +  WT  [Drc  Of  ’ 

[0Crc0]Y+[Drc0]W  u1ax 

1  Vq 

>0, 

Vo  Y 


26 


where 


Let 


Y  YT  [0  0  Crf  +  WT  [0  DJt 

[0  0  Cr  J  Y  A  [0  Dr  J  W 


>0, 


1  vl 
V*  Y 


>0, 


(sin  +  j&W)  -j-  (sin  <f>)(AY  +  BW)^ 

(cos  <t>)(AY  A  BW)  -  (cos  <t>)(AY  A  5 W)T 

0 

0 

0 

AY  A  BW  A  (AY  A  &W)T  A  2 (BY 

<  0 

Y 

^[OC.,of' 

[0COc  0]  Y 

u2 

Cmax 

Y 

YT[0  0Caf' 

[0  0  Ca  J  Y 

u? 

,lmai 

>0, 


>  0. 


A  = 


A  BcC, 

0  A 
0 


c^ac  BhCah 


ac  0 

0  A 


ah 


,B  = 


Bac  o 


0  B. 


ah 


(Ql  (Zo,  Xcgo  VHo  ,VCo  ),  Uhrnax  ,  Uhmax ,  UCmaI ,  UCmax  ,  Vo) 
{Ak,  Bk,  Ck,  R i  S  : 

R  I  CJCI  ' 

ISO  >0, 

CacCk  0  U2Cmax 

R  i  cTkcl 

ISO 

CaeCk  0  u\ 

e  R-max 


>0, 


(11.73) 


(11.74) 
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where 


R 

I 


I  CIBJCI  +  ff[AlCl  0] 
^  Al\Cj,  0] 


u 


C-max 


[0  CreAa]R  +  CScBaCk  [0Crc}Aa 

R  I  CZBjCl+RT[ATaCZ  0] 

I  S  Al\Cl  0] 

[0  CreAa]  R  +  CSeBaCk  [0  CTe]  Aa 


ut 


1  Xq  XqSt 


>  0, 


Xq  R  I 

Sx  o  I  S 

(sin^)(nT  +  n)  (cos^)(-n  +  nr) 
(cos  <^)(n-nT)  (sin  <f>)(iiT  +  n) 


o 

o 


o 


o 


nT  +  n  + 


R  i 

I  s 


2  0 


n  = 


>o, 


>o, 


<0, } 


(11.75) 


A  BcCac  BhCah 

Bay  0  1 

A  BcCq,^ 

BhC«h 

■ 

- 

0  Aac  0 

R  + 

0  Ba,  Ck 

0  Aa& 

0 

0  0  Aah 

L  h  J 

0  0 

Aah 

A  BcCfxc, 

Bh  Cah 

1 

Ak 

S 

0  Aac 

0 

- 

. 

0  0 

Aah  . 

J 

(11.76) 


Then,  a  sufficient  condition  for  the  existence  of  a  dynamic,  output  feedbac- 
controller,  or  static,  state-feedback  controller,  that  stabilizes  the  feedback  system 
Qi  (Z0,  Xcgo ,  Vh0  ,  Vc0 ),  does  not  exceed  actuator  amplitude  and  rate  limits,  and  results 
in  acceptable  flying  qualities  in  response  to  the  angle-of-attack  excursion  defined  by 
i/0,  is  for  the  sets,  or  <J>2  to  be  non-empty.  At  this  point,  we  observed  that  the 
same  numerical  results  were  obtained  using  a  slightly  different  approach.  Instead  of 
minimzing  a  parameter  umax  in  the  LMI  decision  vector,  we  exploited  the  fact  that 
the  short  period  pole  becomes  more  unstable  as  the  center  of  gravity  is  moved  aft. 
This  allowed  the  use  of  a  feasibilty  algorithm  vice  minimization  algorithm  to  acheive 
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the  same  results.  The  benefit  was  a  significant  reduction  in  computational  time.  Now, 
the  Plant  Controller  Optimization  (PCO)  problem  considered  in  this  section  can  be 
stated  as  follows: 

Maximize  { xcg } 

Subject  to: 

^(*0,  tfo,  xcg,  Vh0,Vc0 )  =  0, 

H(Xo,Uo)  =  Z0, 

(Y,  W)  £  (Gi  (xcg,  VHo ,  Vco),  Uhmax,Uhmax,uCmax,uCmaxv0),  (11.77) 

or 

(Ak,Bk,Ck,R,S)  £  $2(Gi  {xcg,VH0,Vc0),uhmax,uhmax,uCmax,uCmaxu0). 

(11.78) 

A  solution  to  this  PCO  problem  includes  a  linear  controller  that  stabilizes  the  feedback 
system  Gi  (Zo,xcgo,VH0,Vc0),  and  meets  actuator  limit  requirements,  as  well  as  a 
providing  a  maximum  aft  center-of-gravity  location. 

The  numerical  solution  used  to  map  the  Tail  Sizing  Design  Space  involved  a 
binary  search  over  center-of-gravity  stations: 

1.  Fix  Vh,Vc,Vt,  7-  Let  Xc3max  =  1  and  xcgmin  =  0. 

2-  xcg0  {Xcgmax  "p  xcgmin)/2- 

3.  Solve  f{X0,  U0,xcg 0)  =  0,  H{X o,  U0)  =  Z0  for  X0,  U0. 

4.  Obtain  A(X0,U0,xcgo),  B(X0,U0,xcgo)  and  form  Q\  (Z0,xcgo). 

5.  Solve  for  (Y,  W)  £  $i  {Gi  (xcg),  uhrnax ,  uhmax ,  uCrnax ,  uCmax ,  vQ)  or, 

6.  Solve  for  ( Ak,Bk,Ck,R,S )  €  $2(£/  (xcg),uhmax,uhmax,uCmax,uCmax,v0). 

7.  If  no  such  (Y,  W)  exist 

*  X  c9max  =  Xcg0l 

else 
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•  xcgmin  —  xcg0‘ 

8.  If  ^  eg  max  ~  xcgmi„  >  g°  to  2. 

9.  Increment  Vh-,  go  to  1. 

4.  Results  -  Rigid  Body  HSCT 

This  design  methodology  was  applied  to  a  number  of  aerodynamic  models 
representative  of  current  high-speed  civil  transport  designs.  The  results  are  shown 
for  the  aerodynamic  model  termed  Ref  A  (see  Appendix  A).  Appendix  A  details  how 
a  convenient  build-up  of  the  nonlinear  longitudinal  dynamics  in  terms  of  wing-body 
and  tail  contributions  facilitates  the  process  of  mapping  the  Tail  Sizing  Design  Space. 

The  state  feedback  synthesis  LMIs  (set  4>i)  were  used.  Figure  8  shows  an 
optimization  run  for  a  single  tail  volume  of  0.2,  no  canard,  and  peak  actuator  rate 
limit  of  30  degrees  per  second.  As  the  center-of-gravity  location  is  moved  aft,  the  peak 
actuator  rate  approaches  the  limit.  The  actuator  amplitude  remained  well  below  its 
saturation  limit,  which  was  set  at  20  degrees  of  travel  from  trim. 
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Figure  8.  Fixed  Tail  Volume  and  Peak  Actuator  Rate  Limit 

Figure  9  details  the  process  for  one  tail  volume  and  a  sweep  of  peak  actuator 
rates.  Again,  the  tail  volume  was  0.2  and  the  peak  actuator  rate  limit  was  incremented 
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from  5  to  30  degrees  per  second.  Notice,  initially  the  center  of  gravity  moves  quickly 
aft  with  only  small  increases  in  the  peak  actuator  rate  required.  However,  at  some 
point,  the  peak  actuator  rate  required  becomes  very  sensitive  to  changes  in  the  center- 
of-gravity  station.  For  the  Ref  A  model,  this  break  point  is  in  the  vicinity  of  0.565 
percent  mean  aerodynamic  cord. 


c.g.  %C 


Figure  9.  Fixed  Tail  Volume,  Sweep  of  Peak  Actuator  Rates 

This  process  is  repeated  for  the  range  of  tail  volumes  of  interest.  Figure  10 
shows  the  results  of  this  process  for  a  tail  volume  of  0.1,  and  a  tail  volume  of  0.2. 
A  two  dimensional  representation  of  the  data  is  cumbersome.  When  repeated  for 
numerous  tail  volumes,  the  Tail  Sizing  Design  Space  could  be  viewed  in  three  dimen¬ 
sions.  Figure  11  shows  the  result  of  fitting  a  surface  to  data  obtained  for  a  range  of 
tail  volumes  from  0.1  to  0.3,  and  a  range  of  peak  actuator  rates  from  5  to  30  degrees 
per  second.  The  surface  represents  a  lower  bound  on  the  peak  actuator  rate  required 
by  the  feedback  control  system  to  recover  from  the  angle-of-attack  excursion,  for  var¬ 
ious  combinations  of  center-of-gravity  location  and  tail  volume.  An  upper  bound  in 
the  Tail  Sizing  Design  Space  would  be  a  fixed  limit  on  the  peak  actuator  rate  avail¬ 
able.  Figure  12  shows  the  inclusion  of  this  plane  for  a  value  of  20  degrees  per  second. 
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The  volume  below  the  plane  and  above  the  curved  surface  represents  the  Tail  Sizing 
Design  Space ,  where  linear  state-feedback  controllers  are  known  to  exist  that  meet 
design  requirements.  Figure  13  shows  the  intersection  of  the  plane  representing  the 
peak  actuator  rate  available  of  15  degrees  per  second,  with  the  curved  surface  rep¬ 
resenting  the  minimum  peak  actuator  rate  required  for  a  rigid-body  HSCT  with  no 
canard.  This  is  seen  to  be  an  aft  center  of  gravity  limit  line  on  the  standard  center 
of  gravity  versus  tail  volume  (scissors)  plot. 


0.4  05  0.6 

c.g.%c 


Figure  10.  Two  Tail  Volumes,  Sweep  of  Peak  Actuator  Rates 

At  this  point,  the  canard  volume  was  fixed  at  0.05.  Following  the  procedure 
outlined  earlier,  the  lower  surface  of  the  Tail  Sizing  Design  Space  was  mapped  for 
a  range  of  horizontal  tail  volumes  from  0.1  to  0.3,  and  for  a  range  of  peak  actuator 
rates  from  5  to  40  degrees  per  second.  Amplitude  and  actuator  rate  limits  for  the 
canard  and  horizontal  tail  were  matched.  Figure  14  shows  the  resulting  lower  bound 
in  the  design  space.  Figure  15  shows  the  results  for  Ref  A  HSCT  with  and  without 
the  canard.  Figure  16  shows  a  slice  of  the  two  surfaces  in  Figure  15  at  a  peak 
actuator  rate  limit  of  15  degrees  per  second.  This  should  be  familiar  as  a  conventional 
scissors  plot.  Of  course,  as  one  would  expect,  the  design  space  increases  with  the 
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c.g.  (%c)  ,ail  volume 

Figure  11.  3D  Tail  Sizing  Design  Space 


additional  control  power  available  from  the  canard.  The  pertinent  question  is  whether 
or  not  there  is  any  benefit  in  spreading  the  control  power  for  and  aft,  so  to  speak, 
or  if  the  Tail  Sizing  Design  Space  would  have  increased  just  as  much  had  the  tail 
volume  alone  been  increased  by  0.05,  and  the  canard  not  added.  In  general,  it  makes 


c.g.  (%c)  tail  volume 


Figure  12.  3D  Tail  Sizing  Design  Space  with  Peak  Actuator  Rate  Limit 
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Figure  13.  2D  Slice  of  the  Tail  Sizing  Design  Space 

more  sense  to  compare  the  competing  configurations  in  terms  of  equal  amounts  of 
combined  horizontal  tail  and  canard  surface  area.  For  instance,  profile  drag  is  more 
closely  related  to  the  surface  area  of  the  control  surfaces,  among  other  things,  and 
the  design  goal  might  be  to  minimize  drag  for  the  same  aft  center- of-gravity  station 
and  actuator  rate  limit.  For  this  example,  which  utilized  the  Ref  A  data,  the  distance 
from  the  vehicle’s  wing-body  neutral  point  to  the  aerodynamic  center  of  the  canard 
or  horizontal  tail  was  the  same.  Therefore,  comparisons  in  terms  of  normalized  area 
or  volume  are  equivalent. 

Figure  17  compares  the  two  configurations,  the  first  without  a  canard  and  the 
second  with  a  canard.  The  percent  change  in  total  control  volume  required  in  going 
from  a  configuration  without  a  canard  to  a  configuration  with  a  canard  is  shown  as  a 
function  of  the  aft  center-of-gravity  limit.  The  same  flying  quality  requirements  and 
actuator  limits  were  used.  For  the  rigid-body  HSCT  model,  the  benefit  gained  from 
the  inclusion  of  a  canard  is  about  a  10  percent  savings  in  total  control  volume. 

This  process  was  repeated,  using  the  output  feedback  synthesis  LMIs  (set  $2). 
Figure  18  shows  the  resulting  Tail  Sizing  Design  Space  obtained  utilizing  dynamic, 
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c.g.  (%c)  tail  volume 

Figure  14.  3D  Tail  Sizing  Design  Space  with  Canard 


full-state,  feedback  controllers.  Figure  19  compares  these  results  with  those  obtained 
utilizing  static,  state-feedback  controllers.  The  intersection  of  the  two  surfaces  with 
the  plane  representing  a  target  rate  limit  of  25  degrees  per  second  is  shown  in  Fig¬ 
ure  20.  By  inspection,  it  is  clear  that  the  limits  of  the  Design  Space  are  nearly 


r  rt 

Figure  15.  Tail  Sizing  Design  Space  With  and  Without  a  Canard 
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Scissor  Plot 


Figure  16.  2D  Slice  of  Tail  Sizing  Design  Space  With  and  Without  a  Canard 

identical.  This  is  an  important  and  somewhat  surprising  result  considering  the  added 
complexity  of  the  output-feedback  controller. 


Figure  17.  Decrease  In  Total  Control  Volume  Through  the  Addition  of  a  Canard 
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Figure  18.  3D  Tail  Sizing  Design  Space  -  Dynamic  Controller 

5.  Problem  Formulation  -  Aeroelastic  Model 

The  development  of  an  integrated  aeroelastic  aerodynamic  model  is  well  docu¬ 
mented  in  work  by  Waszak  and  Schmidt  [Ref.  45].  The  nonlinear  equations  of  motion 
were  derived  using  a  Lagrangian  approach  and  some  standard  simplifying  assump- 


c.g.  (%c)  toil  volume 


Figure  19.  Tail  Sizing  Design  Space  CoTnpavisoni  Static  versus  Dynamic  Controllers 
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Figure  20.  2D  Comparsion:  Static  versus  Dynamic  Controller 


tions.  The  elastic  deformation  is  assumed  sufficiently  small  such  that  linear  elastic 
theory  holds.  Informally,  the  flexible  deformation  is  captured  by  the  contribution  of 
an  infinite  number  of  states  termed  the  generalized  elastic  coordinates.  Associated 
with  each  generalized  elastic  coordinate  is  an  in  vacuo  mode  shape.  In  laymens  terms, 
this  describes  the  shape  of  a  single  elastic  mode  when  fully  deflected.  Of  course,  for 
practical  purposes,  only  a  finite  number  of  elastic  modes  are  retained  for  analysis.  In 
a  body-fixed  reference  coordinate  system,  the  resulting  elastic  airplane  equations  of 
motion  for  the  longitudinal  dynamics  are: 


where, 


m(u  +  qw  +  gsinO ) 

—  Qxi 

m(w  —  qu  —  gcosO) 

=  Qz, 

lyyQ 

=  Qe, 

mi(rji  +  2  (unrii  +  ulg%) 

=  Qvil 

(11.79) 
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Qi  =  generalized,  forces , 

nii  —  generalized  mass ,  (11.80) 

rji  =  generalized  elastic  coordinates. 

Let  V,  and  Z  be  the  total  aerodynamic  and  propulsive  forces  along  each  of  the 

axis  in  the  body-fixed  reference  frame.  Similarity,  let  M  be  the  total  aerodynamic 
and  propulsive  moment  about  the  body-fixed  y- axis.  Define  Sx,  Sz  to  be  virtual 
displacements  along  the  x  and  z  axis,  and  define  SO  be  a  virtual  rotation  about 
the  y  axis.  When  combined  with  the  virtual  pertubations  of  the  elastic  generalized 
coordinates,  %,  the  virtual  displacements  are  called  the  generalized  coordinates.  The 
Principle  of  Virtual  Work  is  used  to  expand  the  generalized  force  terms  in  (11.80) 
through  the  use  of  the  generalized  coordinates.  It  states  that 


Qi  = 


d(SW ) 


(11.81) 


d(Sqt)  ’ 

where  SW  is  the  work  associated  with  an  arbitrary  virtual  displacement  of  the  gen¬ 
eralized  coordinates,  S(]z .  This  virtual  work  done  by  the  aerodynamic  and  propulsive 
forces,  relative  to  the  inertial  reference  frame,  expressed  in  a  coordinate  system  at¬ 
tached  to  the  body  of  the  aircraft,  is: 


SW  =  XSx  +  ZSz  +  [M  +  (zX  -  xZ )]  S0B  +  f  P(x,  z)  •  £  faSrndS.  (11.82) 

Js  «=i 

The  last  term  represents  the  work  done  by  the  distributed  surface  pressure 
due  to  virtual  displacements  of  all  of  the  elastic  generalized  coordinates. 

Applying  (11.82)  to  the  expression  for  virtual  work,  the  generalized  forces  are 
seen  to  be 


n  _  d(<W) 

V *  d(Sx) 


=  X, 


d{SW ) 
d(Sz)  ~  ’ 


(11.83) 

(11.84) 
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(11.85) 


Q“  =  mi=a+{zX^xZ)' 

Q-  =  =  a^T){Is  p(x’ z) '  *iSr<iiS)-  (I1'86) 

At  this  point,  a  method  needs  to  be  chosen  to  determine  the  aerodynamic  and 
propulsive  forces  and  moments.  We  assume  that  a  knowledge  of  wing-body,  tail,  and 
canard  aerodynamic  stability  and  control  derivatives  for  the  rigid-body  aircraft  are 
available.  Furthermore,  the  vehicle  is  assumed  to  have  one  flexible  mode,  with  its 
mode  shape  and  generalized  modal  mass  known.  Generally,  the  first  symmetric  mode 
shapes  of  all  the  HSCT  designs  are  very  similar.  Each  mode  increases  the  number  of 
states  in  the  linear  model  by  two,  which  subsequently  increases  computational  times 
required  by  the  Tail  Sizing  Design  Tool.  Since  the  modes  retained  in  the  linear  model 
are  those  that  we  wish  to  actively  control,  the  maximum  number  of  modes  retained 
would  be  three  or  four.  This  method  can  be  combined  with  other  methods,  [Ref.  45], 
and  used  to  capture  the  residuals  from  the  truncated  modes.  The  method  used  here 
works  well  for  capturing  the  interaction  of  the  rigid-body  states  with  the  flexible- 
body  states  for  the  first  few  symmetric  modes.  It  is  worth  noting  that  the  LMI  based 
Tail  Sizing  Design  Tool  tool  can  utilize  any  method  that  is  capable  of  generating  a 
linear  aeroelastic  model  at  a  specified  center  of  gravity,  tail  volume/canard  volume, 
and  flight  condition.  The  main  contribution  of  this  method  is  its  suitability  to  the 
iterative  nature  of  the  numerical  solution,  and  its  use  of  widely  available  rigid-body 
aerodynamic  stability  and  control  derivatives. 

Therefore,  the  aerodynamic  and  propulsive  forces  are  expressed  in  terms  of  a 
body-fixed  reference  frame  as 

X  =  L  sin  a  —  D  cos  a  +  Tx , 

Z  —  —Lcosa  —  Dsina  +  Tz,  (11.87) 

where  L  and  D  are  the  lift  and  drag  aerodynamic  forces,  a  is  the  angle  of  attack,  and 
Ti  is  the  component  of  thrust  in  the  ith  direction.  The  total  lift  of  the  airplane  is 
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L  —  Lc  +  Lwb  +  Lt , 


(11.88) 


where  the  subscripts  are  meant  to  be  suggestive  of  the  canard,  wing-body,  and  tail 
contributions.  In  coefficient  form,  the  expression  becomes, 

Cl  =  j  CL,  +  CL,b  + 1  CL„  (11.89) 

where  S,  St,  and  Sc  are  the  reference  area  of  the  wing,  tail  and  canard  respectively. 
For  the  problem  at  hand,  (11.89)  is  rewritten  explicitly  in  terms  of  a  tail  and  canard 
volume.  Let  c  denote  the  reference  mean  aerodynamic  cord,  lt  denote  the  distance 
from  the  aerodynamic  center  of  the  tail  to  the  aerodynamic  center  of  the  wing-body, 
and  lc  be  a  similar  length  associated  with  the  canard.  Then,  (11.89)  can  be  expressed 
in  terms  of  control  volumes  as 


Cl  —  VcyCLc  +  Clw1,  +  VuyCLf  (11.90) 

*c  H 

The  individual  lift  coefficients  are  expanded  in  a  first  order  Taylor  series  ex¬ 
pansion  about  the  components  of  the  state  vector  and  control  inputs.  Local  changes 
in  the  free  stream  dynamic  pressure  have  been  incorporated  into  the  local  lift-curve 
slope  derivatives.  For  example,  the  coefficient  of  lift  for  the  tail  is  expressed  as  follows: 


CLt  -  CLto  +  CLt^  —  +  CLta  a  +  CLt .  o:  +  CLtq  q 

OO  OO 

+CLtg  0  +  ^2  CLtrii  rji  +  Y^  CLt.,  f}i  +  CLtUh  Uh.  (11.91) 

i— 1  i= 1  * 

Most  of  the  terms  in  (11.91)  are  familiar  as  aerodynamic  stability  derivatives 
for  a  rigid-body  aircraft.  Some,  such  as  Cl may  be  new  to  the  reader.  In  order  to 
derive  an  approximate  expression  for  these  aeroelastic  stability  derivatives,  we  need 
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to  introduce  the  concept  of  a  mode  shape.  It  is  assumed  that  the  general  elastic  defor¬ 
mation  of  the  unconstrained  body  can  be  described  as  the  product  of  two  functions, 
one  a  function  of  only  spatial  coordinates,  and  the  other  a  time  dependent  function. 
Informally,  the  mode  shapes,  or  free  vibration  modes,  are  the  spatial  function,  and 
the  generalized  elastic  coordinates  are  the  time  function.  Then,  the  local  relative  elas¬ 
tic  displacement  is  described  in  terms  of  the  mode  shape,  and  the  generalized 

coordinate,  as 


d  =  X)  <M x )  •  Vi(t)- 

i=  1 

Similarly,  the  local  relative  elastic  torsion  is  described  as 


(11.92) 


i= 1 


(11.93) 


Expressions  11.92  and  11.93  can  be  used  to  obtain  formulae  for  the  force  and 
moment  dependence  on  flexible  motion.  Again,  considering  the  tail  contribution  to 
lift  as  an  example,  the  lift-curve  slope  dependence  at  the  tail  on  r)  is  computed  from 
the  rigid-body  aerodynamic  stability  and  control  derivatives,  and  from  expressions 
11.92  and  11.93  as 


Cl.,,  (H.94) 

Cl..  (11.95) 

where  xact  is  the  normalized  location  of  the  mean  aerodynamic  center  of  the  tail.  The 
canard  and  wing-body  terms  are  treated  in  an  analogous  fashion.  Once  the  total  lift 
is  calculated,  an  assumed  knowledge  of  a  drag  polar  is  used  to  calculate  the  total 
drag. 


Similar  to  the  build-up  of  the  total  lift  on  the  vehicle,  the  total  pitching  mo¬ 
ment  on  the  vehicle  is  expressed  in  coefficient  form.  Again,  a  first  order  Taylor  series 
expansion  about  perturbations  of  the  state  variables  and  control  inputs  results  in 
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(11.96) 


Cm  —  CMo  +  CMa(x  +  Cm^  +  CW,  <7  +  C'MUhuh 

oo  oo 

+CmUcuc  +  CMniyi  +  22  Vi- 

i=l  i= 1 

The  individual  derivatives  are  written  in  terms  of  the  center-of-gravity  location 
(xcg),  aerodynamic  center  of  the  wing-body  ( xaCwb ),  and  familiar  control  volume  terms 
[Ref.  14].  For  instance, 


and 


C'Ma  CLa  (xcg  XaCwb)  —  VH 


dCL, 

da 


da 


da  ’ 


(11.97) 


Cmk  =  Ci,„(iw-xac.,)-V 'JCl' 


+%^  +  dCM, 


drji 


drji 


%  ’ 


(11.98) 


which  are  composed  of  stability  and  control  derivatives  that  were  either  assumed 
provided  or  previously  computed. 

The  remaining  term  to  consider  involves  expansion  of  the  generalized  force 
associated  with  the  elastic  generalized  coordinates.  Recall, 


Q 


d 


Vi 


d(6ru) 


~{JsP{x,z)-4>i8THdS). 


(11.99) 


As  a  first  step,  the  integral  expression  in  (11.99)  is  separated  into  three  parts: 


Js  P(x,  z)  ■  faSrjidS 


f  P(x,  z)  •  faSriidS  +  f  P(x,  z )  •  faSriidS 

J  c  Jwb 

+  JtP(x’z)-&SVidS.  (11.100) 
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The  pressure  distribution  over  each  surface  is  approximated  by  a  point  force  acting  at 
the  aerodynamic  center  of  the  lifting  surfaces  of  the  aircraft,  and  the  axial  component 
is  ignored.  Therefore,  the  three  integrals  above  are  approximated  as 


I  P(x, z)  •  <f>iSrjidS  »  Fzc(f>i(xaCc)Sj]i  +  FZwb<j)i(xaCwb)8rn  +  FZt<j>i(xaCt)6r]i. 

j  o 

(11.101) 

Then,  using  (11.99),  a  reasonable  approximation  of  the  generalized  forces  is 

Qm  ~  FzJi(xaCc )  +  FZwb4>i(xacwb)  +  FZt<f>i(xaCt).  (11.102) 

Each  term  in  (11.102)  is  expanded  in  a  first  order  Taylor  series  expansion.  The  force 
on  the  tail,  for  instance,  becomes 


FZt  =  FZt„  —  +  FZta  a  +  FZtaa  +  FZtq  q  +  FZtg  6 

oo  oo 

+  E  FZtni  Vi  +  X)  Fztf,.  Vi  +  FZtuh  uh. 

i= 1  i=l 

(11.103) 


Recall,  the  generalized  forces,  Qv ,  drive  the  dynamics  of  the  elastic  generalized  coor¬ 
dinates.  The  rigid-body  states  couple  into  the  elastic  states  via  terms  like 


Fzta<f>i<x{xact )  =  cos  aqSVHyCLta<f>i(xaCt)a,  (11.104) 

H 

and  the  control  inputs  couple  into  the  elastic  states  through  terms  like 

—  —  C  — 

FZtiih<f>i(xact)uh  =  cos  OiqSVHyCL  <f>i(xact)uh.  (11.105) 

H 


The  remaining  terms  couple  the  elastic  states  among  themselves.  Using  the 
fifth  term  in  (11.103)  for  an  example,  we  obtain 
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(11.106) 


FZ%  =  cos  aqSVHfc^^Uj^,), 

and 

FZ%  =  cos  aqSVHjCLt^i(xaCt)i^~^-.  (11.107) 

This  completes  the  description  of  the  modeling  of  the  nonlinear  aeroelastic 
dynamics.  The  intent  was  not  to  document  each  term.  That  level  of  detail  is  left  to 
Appendix  A.  Instead,  the  flavor  of  how  to  incorporate  the  influence  of  a  few  elastic 
modes  was  demonstrated.  The  method  assumed  a  knowledge  of  wing-body,  tail  and 
canard  aerodynamic  stability  and  control  derivatives  for  the  rigid-body,  and  a  set  of 
mode  shapes  and  generalized  modal  masses. 

The  nonlinear  aeroelastic  equations  of  motion  were  linearized  at  an  equilibrium 
point  determined  by  the  flight  condition,  canard  volume  (possibly  zero),  tail  volume, 
and  center  of  gravity.  The  resulting  linear  model  is  given  by: 


where 


xr 

Xe 


Arr  Are 
Aer  Are 
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xr  —  ^  u  w  q  0  j  , 

xe  =  [  i)  r]  |  . 


Generalized  elastic  coordinates  are  somewhat  lacking  in  physical  intuition,  and 
are  not  directly  measured  by  any  sensor  suite.  The  relationships  between  sensed  pitch 
angle  and  pitch  rate  at  a  given  local  body  station  (subscript  /),  the  rigid-body  states 
(subscript  R ),  and  the  generalized  elastic  coordinates  are: 


°1  =  OR-fli'jrUrh, 
1=1  ax 


(11.109) 
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define  a  similarity  transformation  that  replaces  the  generalized  elastic  coordinates, 
q,  f/,  with  a  more  physically  meaningful  pair  of  states,  such  as  qi  and  Or  The  location 
chosen  for  the  placement  of  the  local  pitch  rate  and  pitch  angle  sensors  was  the  cockpit 
station.  Typically,  an  area  is  sought  where  the  mode  shape  slope  has  its  most  positive 
value  [Ref.  1].  The  linearized  aeroelastic  model  now  becomes 
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Using  Ref  A  data  from  Appendix  A,  the  behavior  of  a  rigid-body  HSCT  aircraft 
is  compared  with  an  aeroelastic  model  with  the  first  elastic  mode  retained.  Table  I 
compares  the  eigenvalues  of  the  two  models.  Figure  21  highlights  the  undesirable 
effect  of  the  elastic  motion.  It  shows  the  pitch  rate  sensed  at  the  cockpit  to  a  step 
input  of  the  elevator  for  the  two  models. 

The  frequency  separation  between  the  elastic  mode  and  the  short  period  dy¬ 
namics  is  approximately  1  Hertz,  and  the  damping  of  the  flexible  mode  is  only  0.02. 
Typically,  attempts  are  made  to  attenuate  the  feedback  prior  to  excitation  of  the 
flexible  dynamics.  On  large  transport  aircraft  with  the  flexible  dynamics  close  in 
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Short  Period 

Long  Period 

Flexible  Mode 

frequency 

damping 

frequency 

damping 

frequency 

damping 

Aeroelastic 

0.90 

.75 

0.14 

0.55 

6.7 

0.02 

Rigid-body 

0.91 

.75 

0.14 

0.07 

n/a 

n/a 

Table  I.  Eigenvalues  of  Aeroelastic  and  Rigid-body  Models 


Figure  21.  Pitch  Rate  at  Cockpit,  Aeroelastic  vs.  Rigid  Body 

frequency  to  the  short  period  dynamics,  this  is  hardly  possible.  Furthermore,  even 
if  suitable  notch  or  low-pass  filtering  within  the  control  loop  could  be  attained,  the 
extremely  light  damping  of  the  flexible  modes  results  in  problems  in  terms  of  gust- 
induced  structural  responses  and  fatigue  life.  Therefore,  the  problem  posed  will  be 
one  of  actively  controlling  the  flexible  modes  retained.  Generally,  this  will  entail  im¬ 
proving  the  damping  of  the  flexible  dynamics,  while  ensuring  stability  of  the  short 
period  dynamics  as  the  center  of  gravity  is  moved  aft. 

As  before,  actuator  dynamics  are  appended  to  the  aeroelastic  model.  The 
Plant-Controller  Optimization  problem  formulation  is  exactly  the  same  as  discussed 
in  section  1. 
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6.  Results  -  Aeroelastic  Model 

The  results  are  shown  for  the  aeroelastic  dynamic  model  termed  Ref  B  in 
Appendix  A.  Ref  B  utilizes  the  same  rigid-body  stability  and  control  derivatives  as 
Ref  A.  The  effect  of  a  single,  symmetric,  flexible  mode  was  incorporated.  The  mode 
shape  is  shown  in  Figure  22.  It  was  experimentally  determined  that  requiring  the 
feedback  controller  to  increase  the  damping  of  the  flexible  mode  to  0.05  resulted 
in  acceptable  damping  of  the  short  period  mode.  Once  again,  the  LMI  based  Tail 
Sizing  Design  Tool  was  used  to  map  out  a  surface  in  the  Tail  Sizing  Design  Space. 
Figure  23  shows  the  design  space  for  Ref  B  without  a  canard.  An  upper  bound  in 
the  Tail  Sizing  Design  Space  is  shown  by  the  level  plane  at  a  peak  actuator  rate  of 
25  degrees  per  second.  Figure  24  compares  the  aeroelastic  model  to  the  rigid-body 
model.  Obviously,  considerably  more  actuator  rate  is  required  for  the  aeroelastic 
model  in  order  to  recover  from  the  angle-of- attack  excursion,  while  actively  controlling 
the  flexible  dynamics.  Intuitively,  this  seems  obvious.  The  Tail  Sizing  Design  Tool 
provides  a  metric  for  comparison.  For  example,  consider  a  target  tail  volume  of 
0.20  and  center-of-gravity  station  of  45  percent  mean  aerodynamic  cord.  This  is  well 
within  the  Tail  Sizing  Design  Space  of  the  rigid-body  model,  but  outside  that  of  the 
aeroelastic  model.  The  aeroelastic  model  requires  either  an  extra  0.05  increase  in  tail 
volume,  or  14  degrees  per  second  increase  in  peak  actuator  rate,  to  move  within  its 
Tail  Sizing  Design  Space.  In  some  respects,  this  is  the  price  to  be  paid  for  actively 
controlling  a  non-rigid  vehicle. 

Next,  the  effect  of  the  addition  of  a  canard  to  the  aeroelastic  model  is  explored. 
As  before,  a  canard  volume  of  0.05  was  selected,  and  the  design  space  was  determined. 
The  rest  of  the  design  requirements  remained  unchanged,  and  the  results  are  shown 
in  Figure  25.  Figure  26  compares  the  design  space  of  the  aeroelastic  model  with 
and  without  the  canard.  Figure  27  shows  the  resulting  aft  line  on  the  tail  volume 
sizing  plot  when  the  two  are  cut  at  a  peak  actuator  rate  of  25  degrees  per  second. 
Of  course,  the  added  control  volume  due  to  the  canard  allows  a  further  aft  center-of- 
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Figure  22.  Ist  Symmetric  Mode  Shape 


gravity  location  for  a  similar  actuator  rate  limit. 

The  relative  effect  of  adding  a  canard  is  addressed  by  comparing  the  total 
control  volume,  (Vh  +  Vc),  required  for  a  given  aft  center-of-gravity  limit  and  peak 
actuator  rate  limit.  The  results  are  shown  in  Figure  28  as  a  percent  reduction  in 


c.g.  (%c)  tail  volume 


Figure  23.  3D  Tail  Sizing  Design  Space:  Aeroelastic  Model 
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c.g.  (%c)  tail  volume 


Figure  24.  Tail  Sizing  Design  Space :  Aeroelastic  versus  Rigid  Body  Model 

control  volume  required  in  going  from  the  configuration  without  a  canard  to  the 
configuration  with  a  canard.  Since  the  lengths  of  the  tail  and  canard  moment  arms 
are  the  same,  Figure  28  could  also  represent  a  savings  in  total  control  effector  surface 
area.  Experience  has  shown  that  the  use  of  canards  is  desirable  for  flexible  aircraft 


c.g.  (%c)  tail  volume 

Figure  25.  Tail  Sizing  Design  Space  With  Canard 
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c.g.  (%c)  teil  volume 


Figure  26.  Tail  Sizing  Design  Space  Comparison:  Canard  On  and  Off 

[Ref.  1].  This  method  provides  a  metric  to  quantify  that  benefit.  In  this  example, 
the  inclusion  of  a  canard  is  300  percent  more  effective  when  added  to  the  aeroelastic 
model  then  when  added  to  the  rigid-body  model. 

As  before,  the  process  was  repeated  using  the  output  feedback  LMIs.  The 


Figure  27.  2D  Comparison:  Canard  On  and  Off 
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c.g.  (%c) 

Figure  28.  Decrease  In  Total  Control  Volume  Through  the  Addition  of  a  Canard 

results  utilizing  the  aeroelastic  model  support  the  conjecture  that  dynamic  controllers 
of  the  same  order  as  the  plant  do  no  better  than  static,  state-feedback  controllers. 
A  representative  comparison  is  shown  in  Figure  29.  There  the  aft  center-of-gravity 
stations  are  shown  for  a  range  of  tail  volumes  and  fixed  canard  volume.  The  peak 
actuator  rate  limit  was  40  degrees  per  second. 

D.  GUST  RECOVERY 

A  second  dynamic  requirement  imposed  on  transport  aircraft  is  the  ability 
to  recover  from  a  severe  gust.  The  rationale  is  that  the  open  loop  HSCT  should 
not  be  so  unstable  that  an  unrealistically  fast  actuator  and  flight  control  system  are 
required.  The  gust  recovery  criterion  is  similar  to  that  of  the  high  angle-of-attack 
excursion  in  many  respects.  Both  are  at  their  most  adverse  when  the  vehicle  is  at  a 
slow  speed.  Also,  the  aft  center-of-gravity  configuration  is  limiting.  However,  unlike 
the  high  angle-of-attack  excursion,  which  is  assumed  to  occur  essentially  instantly, 
gust  recovery  criterion  involves  the  vehicle  penetrating  a  particular  wind-shear  over 
time. 
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Figure  29.  2D  Tail  Sizing  Design  Space  Comparison:  Static  versus  Dynamic  Con¬ 
troller  on  an  Aeroelastic  Model 

The  wind-shear  occurs  in  the  vertical  plane,  begins  at  zero  velocity,  builds  to 
some  peak  value,  and  then  dies  out  again.  Since  the  shear  is  defined  to  occur  as 
the  vehicle  crosses  into  a  fixed  region  in  space,  the  rate  at  which  it  is  penetrated 
depends  on  the  flight  speed  of  the  vehicle.  In  some  industry  documents,  the  gust 
profile  is  defined  to  reach  its  peak  within  30  feet  of  travel  of  the  vehicle.  However, 
there  is  ambiguity  as  to  the  rate  and  peak  value  of  the  gust.  The  bottom  line  is  that 
relatively  late  in  the  design/testing  process,  a  flight  simulation  will  be  conducted. 
The  vehicle  will  penetrate  some  gust,  based  on  empirical  weather  data  gathered  from 
airports  throughout  the  country.  Failure  at  this  stage  involves  a  major  redesign. 
What  is  required  is  the  ability  to  quantify  the  concepts  used  in  the  definition  of  the 
design  requirement,  such  as  so  unstable ,  and  unrealistically  fast  actuator.  The  Tail 
Sizing  Design  Tool  provides  a  bench  mark  to  assess  competing  configurations  that  is 
directly  related  to  recovery  from  a  gust  penetration. 

1.  Additional  LMI  Considerations 

Recall  the  state  feedback  synthesis  LTI  system  description. 
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x  —  Ax  +  Bu 
z  =  Cx  +  Du  = 
u  =  if# 

and  suppose  that  the  desired  block  structure  of  the  feedback  gain,  K ,  is 


x  =[A  +  BK]x 
z  =  [C  +  DK}x, 


(11.114) 


I<  = 


I<i  0 


(11.115) 


A  sufficient  condition  to  assure  the  proper  block  structure  of  the  feedback 
gain  is  to  specify  an  appropriate  block  structure  to  the  unknown  variables  in  the 
corresponding  LMIs.  Recall,  for  the  state  synthesis  feedback  problem,  the  feedback 
gain  is  recovered  as  K  —  WY~l .  Therefore,  specify 
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such  that 
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(11.117) 
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2.  Problem  Formulation 


The  gust  recovery  requirement  describes  the  face  of  the  gust  profile  as  a  One 
Minus  Cosine  disturbance.  An  acceptable  alternative  to  the  One  Minus  Cosine  profile 
is  to  fit  two  exponential  functions  to  the  profile.  This  captures  the  important  rapid 
change  in  airmass  velocity  as  the  vehicle  penetrates  the  shear.  Unlike  the  One  Minus 
Cosine  disturbance,  the  gust  velocity  returns  to  zero  after  reaching  its  peak.  The 
rate  of  decay  of  the  gust  velocity  after  reaching  its  peak,  however,  can  be  made  quite 
slow.  Therefore,  the  impact  on  the  vehicle’s  dynamics  is  minimal. 
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Let  tp  be  the  time  it  takes  the  HSCT  to  penetrate  the  shear,  and  let  Gp  be 
the  peak  vertical  velocity  of  the  shear.  Then,  the  following  functions  define  the  two 
wind- shear  profiles. 

One  Minus  Cosine  Profile: 

hit)  =  y(l  -c°s(j^)),  0  <t<tp  (11.118) 

—  t  ^  tp. 

Double  Decaying  Exponential  Profile: 

Mt)  =  ~GP  exp(-Al*)  +GP  exp(-A2*),  0  <  t,  (11.119) 

where 

Ai  =  3tp,  and  A2  =  (11.120) 

Both  wind-shear  profiles  are  shown  in  Figure  30. 


Figure  30.  Two  Wind  shear  Profiles 

Let  the  vehicle  s  linearized  longitudinal  dynamics  be  given  by  the  LTI  system 
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v  =  Av  +  Bu, 
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(11.121) 


as  before.  Based  on  (11.119),  the  state  space  description  of  the  wind-shear  is 
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where  vg  is  the  vertical  velocity  of  the  shear.  Now,  a  model  of  the  vehicle’s  dynamics 
in  an  airmass  whose  vertical  velocity  is  vg(t)  is 
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The  velocity  states  in  (11.123)  are  inertially  referenced  quantities.  Consider  a 
similarity  transformation  based  on  the  change  of  variables, 


C  =  Trj, 


where 
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C  =  TAjT-'C  +  TBju, 

—i  AC*  -f-  Bu, 

Co  =  Tt)0.  (11.123) 

Then,  the  first  two  states  of  (  are  perturbations  in  true  airspeed  and  angle  of 
attack,  both  airmass  relative  quantities.  This  makes  the  first  four  states  of  (  natural 
quantities  to  be  considered  for  feedback.  However,  for  all  practical  purposes,  the  gust 
states  are  not  measured,  and  should  not  be  considered  for  feedback.  This  implies  that 
the  feedback  considered  should  be  of  the  form: 


K  = 


Ky  0 


(11.124) 


where  C2  corresponds  to  the  gust  states,  and  ('i  corresponds  to  all  of  the  remaining 
states. 


3.  Proposed  Numerical  Solution 

Let 
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Now,  replace  with  $3  in  (11.77),  and  proceed  with  the  algorithm  outlined 
in  section  (3). 


4.  Gust  Recovery  Results 

This  design  tool  was  being  developed  concurrently  with  a  NASA  led  multi¬ 
corporate  effort  to  define  a  baseline  configuration  for  an  HSCT  vehicle.  The  design 
engineers  desired  the  ability  to  quickly  asses  the  influence  of  changes  in  key  parameters 
of  the  wind-shear  on  the  final  design.  This  necessitated  that  computational  time  be 
kept  short,  on  the  order  an  hour  or  less,  since  the  intention  was  to  investigate  multiple 
scenarios  throughout  the  day. 

In  that  light,  the  gust  recovery  criterion  was  applied  to  the  numerical  model, 
Ref  A,  with  a  fixed  tail  volume  of  0.11  and  no  canard.  Still  to  be  finalized  were  the 
design  requirements  concerning  the  definition  of  the  wind-shear.  The  design  team 
desired  to  know  how  sensitive  their  designs  were  to  changes  in  peak  values  of  the 
wind-shear  and/or  time  to  penetrate  the  wind-shear.  The  Tail  Sizing  Design  Tool 
was  used  to  compute  aft  center-of-gravity  stations  for  differing  wind  shear  profiles. 

Figure  31  shows  the  sensitivity  of  the  aft  center  of  gravity  location  to  changes 
in  the  peak  value  of  the  gust.  The  penetration  distance  is  one  cord  length.  The  peak 
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gust  velocities  were  30,  45,  and  60  feet  per  second.  The  data  indicates  that  at  around 
20  degrees  per  second  peak  actuator  rate,  every  50  percent  increase  in  the  peak  gust 
velocity  pushes  the  aft  center-of-gravity  station  forward  10  percent. 
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Figure  31.  Increasing  the  wind-shear  peak  velocity  moves  the  center  of  gravity  limit 
forward. 

On  the  other  hand,  figure  32  shows  the  sensitivity  of  the  aft  center  of  gravity 
location  to  changes  in  the  penetration  distance.  The  peak  gust  velocity  was  45  feet 
per  second.  A  penetration  distance  of  1,  l|,  and  2  cord  lengths  is  shown.  Choosing 
an  actuator  rate  limit  of  20  degrees  per  second  again,  every  50  percent  increase  in 
wind-shear  penetration  distance  pushes  the  aft  center-of-gravity  station  aft  5  percent. 

On  a  percentage  basis,  the  aft  center  of  gravity  limit  is  about  twice  as  sensitive 
to  changes  in  the  peak  wind-shear  velocity  as  it  is  to  changes  in  the  penetration 
distance. 

E.  CONCLUSIONS 

The  sizing  of  the  horizontal  control  surface(s)  for  HSCT  is  a  difficult  problem. 
Traditionally,  aircraft  definition  has  taken  place  apart  from  feedback  considerations. 
Controller  design  was  a  derivative  process,  with  little  contribution  to  the  aircraft 
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Figure  32.  Increasing  the  wind-shear  penetration  distance  moves  the  center-of-gravity 
limit  aft. 

definition.  Of  course,  the  aircraft  were  statically  stable,  and  feedback  control  was 
viewed  as  a  significant  enhancement  but  not  flight  critical.  This  is  an  interesting 
example  of  an  application  where  traditional  methods  simply  lack  the  necessary  tools 
to  adequately  define  the  aircraft  configuration.  Clearly,  the  aircraft  definition  will 
come  first.  However,  it  must  be  done  with  tools  that  provide  a  quantifiable  knowledge 
of  the  impact  on  the  demands  of  the  feedback  control  system. 

The  most  intuitive  metric  to  select,  capturing  the  demands  of  the  feedback 
control  system,  is  the  peak  actuator  rate  required.  The  inclusion  of  this  metric 
adds  an  extra  dimension  to  the  tail  sizing  problem.  The  two  dimensional  tail  sizing 
scissors  plot  is  inadequate,  and  a  natural  extension  is  the  Tail  Sizing  Design  Space. 
A  conventional  scissors  plot  can  be  recovered  by  viewing  the  intersection  of  the  Tail 
Sizing  Design  Space  with  a  level  plane.  However,  the  three  dimensional  space  allows 
the  designer  to  see  how  sensitive  the  aft  boundary  is  to  changes  in  actuator  rate. 
Clearly,  there  is  value  in  knowing  when  small  changes  in  the  center-of-gravity  location 
result  in  large  changes  in  the  actuator  rate  required. 

While  not  solvable  analytically,  new  efficient  algorithms  make  the  problem 
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tractable  numerically.  A  new  design  tool  is  provided  that  provides  the  capability 
to  quickly  determine  the  Tail  Sizing  Design  Space  for  a  given  aircraft  configuration. 
This  chapter  demonstrates  that  many  tail  sizing  problems  can  be  formulated  as  LMIs, 
and  exploit  new  interior  point  algorithms  to  obtain  exact  numerical  solutions.  The 
iterative  nature  of  the  design  process  requires  a  tool  that  can  generate  solutions  in 
a  timely  manner.  Using  the  Tail  Sizing  Design  Tool,  the  user  can  make  adjustments 
to  the  aircraft  definition,  and  quantifiably  asses  the  impact  on  the  demands  of  the 
feedback  control  system. 

In  the  first  half  of  the  chapter,  two  fundamental  changes  in  aircraft  definition 
were  explored.  Their  influence  on  the  Tail  Sizing  Design  Space  for  a  representative 
model  of  an  HSCT  was  quantified.  The  first  was  the  use  of  canards  in  addition  to  a 
horizontal  tail.  The  second  was  the  effect  of  simple,  flexible  motion.  This  resulted  in 
the  testing  the  matrix  of  basic  aircraft  configurations  shown  in  table  E.  Additionally, 
the  effect  of  using  a  static,  state-feedback  controllers,  or  dynamic,  full-state,  output- 
feedback  controllers,  was  investigated  for  each  element  in  the  matrix. 


Rigid  Body-Tail  Only 

Rigid  Body- Tail  with  Canard 

Flexible  Body-Tail  Only 

Flexible  Body-Tail  with  Canard 

Table  II.  Matrix  of  Aircraft  Definitions  Tested 


Numerical  results  suggest  that  canards  provide  a  small  benefit  for  a  rigid  body 
HSCT.  Their  use  is  more  effective  when  used  on  a  flexible  body  HSCT.  The  metric 
used  to  asses  their  effectiveness  was  the  change  in  total  horizontal  control  volume. 
In  this  example,  an  aeroelastic  model  realized  a  reduction  in  total  horizontal  control 
volume  of  approximately  30  percent  through  the  use  of  a  canard.  The  rigid-body 
model  realized  a  reduction  in  total  horizontal  control  volume  of  approximately  10 

percent.  The  use  of  a  dynamic,  full-state,  output-feedback  controller  did  not  improve 
the  results. 
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In  the  second  part  of  the  chapter,  a  different  dynamic  constraint  from  the  high 
angle-of-attack  excursion  was  addressed.  The  dynamic  constraint  was  the  penetration 
of  a  severe  vertical  wind-shear.  The  definition  of  the  wind-shear  profile  was  open. 
Therefore,  the  effect  of  changes  in  the  wind-shear  profile  on  the  Tail  Sizing  Design 
Space  for  a  rigid-body  HSCT  was  explored.  In  this  example,  a  boundary  of  the  Tail 
Sizing  Design  Space  was  found  to  be  twice  as  sensitive  to  changes  in  the  peak  level  of 
the  gust  then  to  changes  in  the  distance  to  penetrate  the  gust. 
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III.  INTEGRATED  GUIDANCE  AND 

CONTROL 


A.  INTRODUCTION 

In  a  great  number  of  envisioned  mission  scenarios,  Autonomous  Vehicles  will 
be  required  to  follow  inertial  reference  trajectories  accurately  in  3-D  space.  See,  for 
example,  [Ref.  36,  9,  11]  and  the  references  therein.  Similar  requirements  emerge 
from  the  recent  work  at  NASA  on  the  descent  trajectory  synthesis  for  air  traffic 
control  [Ref.  43].  To  achieve  this  goal,  the  following  systems  must  be  designed  and 
implemented  on  board  autonomous  vehicles  (AVs):  i)  navigation ,  to  provide  estimates 
of  linear  and  angular  positions  and  velocities  of  the  vehicle,  ii)  guidance,  to  process 
navigation/inertial  reference  trajectory  data  and  output  set-points  for  the  vehicle’s 
(body)  velocity  and  attitude,  and  iii)  control,  to  generate  the  actuator  signals  that 
are  required  to  drive  the  actual  velocity  and  attitude  of  the  vehicle  to  the  values 
commanded  by  the  guidance  scheme. 

The  advent  of  GPS  (Global  Positioning  System)  has  afforded  AV  systems  en¬ 
gineers  a  powerful  new  means  of  obtaining  accurate  navigation  data  that  is  required 
for  precise  tracking  of  given  inertial  trajectories.  However,  traditional  guidance  and 
control  schemes  used  to  steer  the  vehicle  along  such  trajectories  may  prove  inade¬ 
quate  in  the  case  where  frequent  heading  changes  are  required,  or  in  the  presence  of 
shifting  wind  [Ref.  35].  Traditionally,  such  systems  are  designed  separately,  using 
well  established  design  methods  for  control,  and  simple  strategies  such  as  line  of  sight 
(LOS)  for  guidance.  See  [Ref.  20]  and  [Ref.  29]  for  interesting  applications  to  un¬ 
derwater  and  air  vehicles,  respectively.  During  the  design  phase,  the  control  system 
is  usually  designed  with  sufficiently  large  bandwidth  to  track  the  commands  that  are 
expected  from  the  guidance  system.  However,  since  the  two  systems  are  effectively 
coupled,  stability  and  adequate  performance  of  the  combined  system  about  nominal 
trajectories  are  not  guaranteed  [Ref.  35].  In  practice,  this  problem  can  be  resolved  by 
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judicious  choice  of  guidance  law  parameters  (such  as  the  ’’visibility  distance”  in  LOS 
strategy),  based  on  extensive  computer  simulations.  Even  when  stability  is  obtained, 
however,  the  resulting  strategy  leads  to  finite  trajectory  tracking  errors,  the  magni¬ 
tude  of  which  depends  on  the  type  of  trajectory  to  be  tracked  (radius  of  curvature, 
vehicle’s  desired  speed,  etc.)  [Ref.  35]. 

This  chapter  proposes  a  new  methodology  for  the  design  of  guidance  and  con¬ 
trol  systems  for  AVs,  whereby  the  two  systems  are  designed  simultaneously.  This 
methodology  has  two  main  advantages  over  traditional  ones:  i)  the  resulting  trajec¬ 
tory  tracking  system  achieves  zero  steady  state  tracking  error  about  any  trimming 
trajectory,  and  ii)  the  design  methodology  explicitly  addresses  the  problem  of  stability 
of  the  combined  guidance  and  control  systems. 

Earlier  work  based  on  this  approach  can  be  found  in  [Ref.  15,  42,  25].  In  par¬ 
ticular,  the  authors  introduce  a  methodology  for  the  design  of  controllers  for  UAVs 
to  track  inertial  trajectories  that  are  given  in  space  and  time  coordinates.  The  tra¬ 
jectories  considered  are  equilibrium  (also  known  as  trimming)  trajectories  of  AVs, 
which  are  helices  parameterized  by  the  vehicle’s  linear  speed,  yaw  rate  and  flight 
path  angle.  Furthermore,  in  [Ref.  15,  42,  25]  it  is  shown  the  linearization  of  the  vehi¬ 
cle  error  dynamics  and  kinematics  about  any  trimming  trajectory  is  time-invariant. 
Thus,  the  problem  of  designing  integrated  guidance  and  control  systems  for  AVs  to 
accurately  track  trimming  trajectories  can  be  solved  by  using  tools  that  borrow  from 
gain  scheduling  control  theory,  particularly  those  reported  in  [Ref.  27].  Within  the 
framework  of  [Ref.  27],  the  vehicle’s  linear  speed,  yaw  rate,  and  flight  path  angle  play 
the  role  of  scheduling  variables  that  interpolate  the  parameters  of  linear  controllers 
designed  for  a  finite  number  of  representative  trimming  trajectories.  The  results  in¬ 
troduced  in  [Ref.  27]  on  the  D-implementation  of  gain  scheduled  controllers  can  then 
be  used  to  obtain  a  combined  guidance/control  system  such  that  the  properties  of  the 
linear  designs  are  recovered  locally,  about  each  trimming  trajectory.  An  interesting 
and  very  important  consequence  of  the  ^-implementation  is  that  it  leads  naturally  to 
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a  controller  structure  where  the  only  exogenous  commands  required  are  the  desired 
linear  inertial  position  and  the  yaw  rate,  thus  avoiding  the  need  to  feedforward  the 
trimming  conditions  for  the  remaining  state  variables  and  control  inputs. 

However,  the  technique  presented  in  [Ref.  15,  42,  25]  has  a  shortcoming  which 
may  be  of  concern  for  UAVs  and  AUVs  when  tracking  trimming  trajectories  in  the 
presence  of  changing  air  and  water  mass.  Since  the  controllers  described  in  those 
references  achieve  accurate  tracking  of  trajectories  defined  in  terms  of  space  and 
time  coordinates,  the  relative  speed  of  the  vehicle  with  respect  to  the  air  cannot  be 
controlled  externally,  its  value  being  computed  internally  as  a  function  of  the  tracking 
error.  In  practice,  this  may  lead  to  unacceptable  performance  in  the  presence  of  winds, 
since  the  change  in  the  airspeed  of  the  vehicle  may  result  in  stall  or  structural  damage. 

Clearly,  eliminating  the  time  coordinate  in  the  trajectory  definition  and  using 
the  vehicle  attitude  to  null  out  trajectory  errors  while  maintaining  constant  airspeed 
should  resolve  this  problem.  A  similar  approach  has  been  introduced  in  a  number  of 
publications  on  robot  control.  Of  particular  interest  is  the  work  reported  in  [Ref.  40], 
where  the  subject  of  path  following  control  for  wheeled  robots  is  addressed.  See  also 
[Ref.  35]  for  a  detailed  analysis  of  the  stability  of  an  autonomous  underwater  vehicle 
about  nominal  trajectories  in  the  horizontal  plane. 

In  this  chapter,  these  ideas  are  formalized  within  the  basic  framework  for  3-D 
trajectory  tracking  controller  system  design  developed  in  [Ref.  15,  42,  25].  Using 
the  concepts  outlined  in  [Ref.  40],  the  linear  position  of  an  AV  is  given  in  terms 
of  its  location  with  respect  to  the  closest  point  on  a  desired  trajectory,  together 
with  the  arc  length  of  an  imaginary  curve  traced  along  that  trajectory.  Tracking  of  a 
trimming  trajectory  by  the  vehicle  at  a  fixed  speed  is  then  converted  into  the  problem 
of  driving  a  generalized  error  vector  -  which  implicitly  includes  the  distance  to  the 
trajectory  -  to  zero.  Moreover,  it  is  shown  that  the  linearization  of  the  generalized 
error  dynamics  about  the  corresponding  trimming  path  is  time-invariant.  Using  these 
results,  the  problem  of  trajectory  tracking  is  posed  and  solved  in  the  framework 
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of  gain  scheduled  control  theory,  leading  to  a  new  technique  for  integrated  design 
of  guidance  and  control  systems  for  AVs.  The  chapter  summarizes  the  resulting 
design  methodology,  and  illustrates  its  application  to  the  design  and  implementation 
of  a  nonlinear  trajectory  tracking  controller  for  the  UAV  Frog  [Ref.  25].  Numerical 
simulations  using  a  full  set  of  nonlinear  equations  of  motion  of  the  vehicle  show  the 
effectiveness  of  the  proposed  techniques. 

The  subject  of  trajectory  tracking  has  also  been  addressed  in  the  literature 
on  control  of  nonholonomic  vehicles.  In  [Ref.  44],  the  problem  of  tracking  a  nominal 
trajectory  by  a  nonlinear  system  is  considered.  The  key  idea  includes  linearizing  the 
nonlinear  system  along  the  trajectory,  then  using  the  resulting  time  varying  lineariza¬ 
tion  to  obtain  a  time  varying,  state-feedback  controller  that  locally  exponentially  sta¬ 
bilizes  the  system  along  the  trajectory.  The  paper  includes  examples  of  applications 
of  the  proposed  technique  to  a  mobile  robot  and  a  front  wheel  drive  car.  The  nominal 
trajectories  considered  in  [Ref.  44]  are  not  restricted  to  be  trimming  trajectories. 
However,  all  the  examples  presented  consider  the  case  of  trimming  trajectories  only. 
Another  approach  is  used  in  [Ref.  19],  where  a  tracking  problem  for  a  surface  ma¬ 
rine  vessel  is  considered.  Here  the  authors  use  feedback  linearization  with  dynamic 
extension  to  obtain  a  controller  to  track  trajectories  that  consist  of  lines  and  arcs  of 
circles  (a  special  case  of  trimming  trajectories  in  the  plane). 

The  solution  to  the  trajectory  tracking  problem  proposed  in  this  chapter  dif¬ 
fers  considerably  from  the  ones  introduced  in  [Ref.  44,  19].  Here,  the  key  idea  is  to 
reduce  the  problem  to  the  design  of  a  tracking  controller  for  a  linear-time  invariant 
plant  utilizing  a  simple  nonlinear  transformation  that  inverts  the  vehicle  kinematics. 
This  poses  no  robustness  concerns  since  kinematics  are  usually  well  known,  partic¬ 
ularly  in  the  case  of  air  and  underwater  vehicles.  It  is  important  to  point  out  that 
the  application  of  the  nonlinear  transformation  results  in  a  nonlinear  plant,  whose 
linearization  along  trimming  trajectories  is  time-invariant.  Once  in  the  linear  setting, 
the  designer  is  free  to  choose  his  favorite  control  synthesis  technique  to  achieve  the 
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desired  closed-loop  performance  and  robustness.  The  chapter  provides  a  simple  al¬ 
gorithm  for  implementing  the  linear  controller  on  the  nonlinear  plant  such  that  the 
properties  of  linear  controller  are  preserved  along  each  trajectory.  This  is  in  contrast 
to  the  approach  in  [Ref.  44],  where  the  problem  is  reduced  to  that  of  designing  an 
exponentially  stabilizing  state-feedback  controller  for  a  linear  time-varying  system. 
This  leads  to  a  controller  design  that  is  problem  specific  and  does  not  address  the 
issues  of  performance  and  robustness.  On  the  other  hand,  in  [Ref.  19]  the  authors 
point  out  that  extending  to  air  vehicles  the  feedback  linearization  technique  use  for 
trajectory  tracking  of  the  surface  craft  is  difficult  due  to  the  unstable  zero  dynamics 
that  are  characteristic  of  aircraft. 

The  chapter  is  organized  as  follows.  Section  B  develops  the  rigid  body  dy¬ 
namics  and  introduces  appropriate  notation.  Section  C  introduces  the  error  dynam¬ 
ics  necessary  to  solve  the  problem.  Section  D  formulates  and  solves  the  problem  of 
integrated  guidance  and  control  of  UAVs  for  the  class  of  trajectories  introduced  in 
Section  C.  Section  E  describes  an  application  to  the  integrated  guidance  and  control 
of  the  UAV  Frog.  Finally,  Section  F  contains  the  main  conclusions. 

B.  RIGID  BODY  DYNAMICS 

This  section  begins  with  a  review  of  the  equations  governing  the  motion  of  a 
rigid  body,  and  specifically  of  an  unmanned  air  vehicle.  Notation  familiar  in  robotics 
[Ref.  10],  but  not  commonly  used  in  the  field  of  aircraft  dynamics,  is  introduced.  It 
is  hoped  that  the  familiar  environment  of  the  equations  of  motion  of  a  rigid  body  will 
make  the  reader  comfortable  with  the  notation.  It  will  be  used  extensively  later  in 
developing  an  integrated  guidance  and  control  algorithm. 

Let  {/}  denote  an  inertial  reference  frame.  For  the  purposes  of  this  devel¬ 
opment,  the  rotation  of  the  earth  and  its  associated  Coriolis'  force  can  be  ignored. 
Thus,  a  local  tangent  plane  reference  frame  will  be  considered  an  inertial  reference 
frame.  Let  {B}  denote  a  body  coordinate  frame  that  is  fixed  with  respect  to  the  body 
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of  the  vehicle.  Finally,  let  {W}  denote  a  stability  coordinate  frame  aligned  with  the 
velocity  vector  of  the  vehicle. 

Free  vectors  can  be  expressed  in  whatever  reference  frame  is  most  convenient. 
The  velocity  of  the  vehicle  with  respect  to  {/}  is  a  free  vector.  When  resolved  in 
{ B },  it  will  be  described  by 


V 


u  v 


(MI-1) 


Free  vectors  can  be  transformed  from  one  frame  to  another  via  the  rotation  matrix 
describing  the  relative  orientation  of  the  two  frames.  For  example,  it  is  common  to 
describe  the  orientation  of  {B}  with  respect  to  {/},  by  the  Euler  angles  (<p,  6 ,  ip). 
Let 


A 


e 

%p 


then  fR( A),  or  simply  f  R,  is  the  rotation  matrix  from  {/}  to  {B},  and  given  by 


B 

I 


R 


cos(e)  cos(ip)  cos(0)  sin(^>)  —  sin(0) 

sin(<£)  sin(0)  cos(t^)  —  cos(<£)  sin(^)  s'm(ip)  sin(6) sin(fp)  +  cos(<p)  cos( ip)  sin(<£)  cos(theta) 
co  s(<p)  sin(0)  cos  (ip)  +  sin(<£)  sin  (ip)  cos(^)  sin(0)  sin(psi)  —  sin(^>)  sin(ps*)  cos(<p)  cos(0) 


(III-2) 


As  an  example,  consider  the  position  P  of  the  vehicle.  Its  velocity,  ~P,  in  {/}  can 
be  expressed  as 


Another  common  rotation  matrix  relates  the  orientation  of  {J3}  to  the  stability 
axis  of  the  vehicle  {W}.  The  vehicle’s  angle  of  attack,  a,  and  side-slip  angle,  /?, 
define  the  orientation  of  {W}  with  respect  to  {£?}.  The  associated  rotation  matrix 
is  termed  ^R(oc,/3).  As  an  example,  if  V  is  the  velocity  of  the  vehicle  with  respect 


68 


to  {/},  resolved  in  {B},  then 


mi 

0 

0 


is  the  same  vector  resolved  in  {W}. 

The  angular  velocity  of  {B},  with  respect  to  {/},  resolved  in  {B}  will  be 
represented  by  Cl.  It  is  the  set  of  familiar  body-fixed  rotation  rates,  roll  rate  ( p ), 
pitch  rate  ( q ),  and  yaw  rate  (r).  The  body-fixed  rotation  rates  are  related  to  the 
Euler  angles  by 


p 

1 

0 

—  sin(0) 

1 _ 

9 

0 

COS  ((f)) 

sin(<^)  cos(0) 

d  a 
dt“ 

r 

0 

—  sin(^) 

cos (<f>)  cos(0) 

- 1 

_ I 

=  Q  1(A)A.  (III. 3) 


Inverting  (III.3),  the  time  rate  of  change  of  A  is  related  to  O  by  the  matrix  Q(A),  or 
simply  Q,  as 


d 

dt 


A  =  Qfi, 


Q(  0)  =  I. 


(IH.4) 


Using  this  notation,  an  application  of  Newton’s  Law  to  the  linear  and  angular 
motion  of  the  vehicle  yields 


jV  =  -ftxV  +  -, 
dt  m 

X  Ifift-f  Tg'N, 


(III.5) 


where  F  and  N  are  the  total  external  force  and  moment  acting  on  the  vehicle  resolved 
in  {B},  m  is  the  body  mass,  and  1B  is  the  inertia  tensor  of  the  body  resolved  in  { B}. 

Standard  practice  is  to  separate  out  the  contribution  of  gravity,  (&'),  from  the 
force  and  moment  terms.  The  remaining  terms  are  expanded  in  a  first  order  Taylor 
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series  expansion  about  some  choice  of  state  variables  and  control  inputs.  A  convenient 
choice  of  state  variables  is  (u,  /3,  a,  p,  q ,  r),  and  standard  control  inputs  are  elevator 
(Se),  aileron  (6a),  rudder  (Sr)  and  throttle  (St).  Applying  this  to  (III.5)  results  in 
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where 

s  :=  wing  reference  area, 

c  :=  wing  mean  chord, 

m  :=  mass, 

Tb  aircraft’s  inertia  tensor  resolved  in  {B}, 

p  :=  air  density, 

b  wing  span, 

D,  Y,  L  :=  normalized  drag,  lateral  force  and  lift, 

Z,  M,  N  :=  normalized  roll  pitch  and  yaw  moments, 

CX0  :=  normalized  nominal  force  or  moment  coefficient, 

CXy  :=  stability  derivative:  ||. 

Notice  that  some  symbols  in  (III.6)  and  (III.7)  have  multiple  meanings,  and  attention 
must  be  paid  to  the  context  in  which  they  are  used.  The  terminology  is  standard  in 
aircraft  dynamics. 

A  convenient  grouping  of  terms  in  (III.6)  and  (III.7)  is  to  let  H  be  a  vector 
valued  function  of  the  control  inputs,  X  be  a  vector  valued  function  of  all  the  terms 
affine  in  'H ,  and  J-  be  a  vector  valued  function  of  all  the  remaining  terms.  Then, 
equations  III. 6  and  III. 7  can  be  compactly  expressed  in  terms  of  these  functions. 
Subscripts  are  used  to  indicate  the  correspondence  of  the  function  to  the  appropriate 
linear  or  angular  motion  equation.  As  an  example, 

Cdh  CdSc  0  0 

Iv  :=  ^PWVW2sKw{a,l3)  o  0  CV,a  Cy6r  ■  (HI.8) 

ClS(  Cl6s  0  0 

Then,  the  complete  equations  of  motion  of  the  vehicle  are  expressed  in  this  notation 
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'  ±v  =fv(v,n,A)  +  iv(v,n)n(v,u,u), 
g  =  \ia  *^o(v;n,A)  +  Mv,n)H(v,n,u), 
ip  =1 bRV , 

.  i  A  =  2  «■ 

C.  GENERALIZED  ERROR  DYNAMICS 
1.  Trimming  Trajectories 


(III.9) 


The  objective  of  the  guidance  and  control  systems  is  to  steer  an  autonomous 
vehicle  along  prescribed  inertial  trajectories  Pc  G  II3.  Furthermore,  we  require  that 
the  vehicle  be  trimmed  along  any  such  trajectory.  Let  {C}  define  the  coordinate 
system  attached  to  the  vehicle,  and  let  Ac  define  the  desired  inertial  orientation  of 
{C}.  The  coordinate  system  { C }  represents  the  desired  inertial  orientation  of  the 
vehicle  along  Pc.  Therefore,  at  trim  {5}  =  { C }.  Next,  we  define  the  set  £  of  the 
trimming  trajectories  about  which  the  vehicle  is  expected  to  operate: 


i  pc  =b  RVc , 

^  Ac  =  Q{Ac)  £tc  =■  Qc^c, 

Fv(Vc,{lc,Ac)  +  MVc,no)H(Vo,nc,Uc)  =  0i 

MVc,  ftcr,  Ac)  +  VFc,  VcMVc,  Oc,  Ue)  =  0, 

(III.10) 

where  Vc,  Vic  and  Uc  denote  the  trimming  values  of  V,  0  and  [/,  respectively,  and  Ac 
denotes  the  vector  of  Euler  angles  that  describe  the  orientation  of  {C}  with  respect 
to  {/}. 

From  the  definition  of  £  and  equations  III.9,  it  can  be  concluded  [Ref.  13] 
that  trimming  trajectories  Pc  G  £  correspond  to  helices: 


Pc 

Ac 


0 

0  , 


(III.11) 
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? 


(III.12) 


where 


—vc  cos  (7C)  sm(ij>ct) 
vc  cos(7c)cos  (ipct) 
—vc  sin(7c) 


ipc  =  desired  turn  rate, 
vc  =  desired  inertial  velocity, 
7c  =  desired  flight  path  angle. 


Thus,  the  trimming  trajectories  can  be  parameterized  by  the  vector 


Vc  =  [yc,i,7cf  e  ft3. 


(III.  13) 


In  fact,  given  r/c,  we  can  determine  the  trimming  values  for  Vc ,  flc  and  Uc  which  will 
be  important  later  for  the  controller  synthesis. 

Integrating  (III. 12)  we  obtain 


cos(,M) 


“5^1(4*) 


Pc(t)  = 

I  ' 

-uc  sm(7c)t 

Equation  III.  14  indicates  that  the  radius  of  the  helix  is 

vc  cos(7c) 


bc  := 


fp c 


and  the  climb  rate  is 


(III. 14) 


(III.15) 


hc  :=  -ucsin(7c). 


(III. 16) 


Using  elementary  ideas  from  differential  geometry  [Ref.  3],  equation  III.14  can  be 
reparameterized  by  considering  the  arclength  s  defined  as 


s 


J  \\jtPc(t)\\it, 
J  vcdt. 


(III.17) 
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Although  the  symbol  for  arclength  is  the  same  as  that  used  in  other  sections  for  the 
Laplace  transform  variable,  it  is  hoped  that  the  context  will  make  the  distinction 
clear.  Then,  using  (III. 15), (III. 16)  and  (III.17),  equation  III.  1 4  is  written  as 


Pc(») 


be  cos(^c^) 

6csin(4^)  • 


(III. 18) 


Two  parameters  useful  in  describing  the  helix,  P<?(s),  are  its  curvature  and  its 
torsion.  The  curvature  is  defined  in  terms  of  the  parameters  in  rjc  as 


and  the  torsion  as 


k(s)  = 


ipccos(  7C) 


(III.19) 


r(s) 


hcipc 

9  ’ 

v2 

ipc  sin  7C 


vc 


(III.20) 


2.  Trimming  Trajectory  Coordinate  System 

Now,  let  {A}  denote  a  Frenet  frame  attached  to  Pc(. s)  [Ref.  3].  The  x  axis  of 
the  Frenet  frame  is  termed  T.  It  is  a  unit  vector  tangent  to  Pc(s)  at  s,  and  it  points 
in  the  direction  of  motion  on  Pc(s).  Its  components  are  defined  as 


r<„-™ 

-^sin(^t) 

=  ^C0S(^c£)  , 

-he 

Vc 

-  cos (7c)  sin(^c^) 

=  cos(7c)  cos(^c^) 

-  sin(7c) 


(III. 21) 
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The  y  axis  is  termed  N  and  is  perpendicular  to  T.  It  is  a  unit  vector  pointing  toward 
the  center  of  the  helix,  and  it  is  defined  as 

A7Y„\  _  dT(s )  , 


ir /*>• 

-  cos(^4) 

-  sin(V>c^) 


(III.22) 


The  z  axis  is  termed  B,  and  is  orthonormal  to  T  and  N.  It  is  defined  according  to 
the  right  hand  rule,  B(s )  =  T(s )  x  N(s): 

sin(7c)sin(</>c£) 

B(s)  =  -sin(7c)cos(V>4)  *  (HI-23) 

cos(7c) 

The  rotation  matrix  from  {A}  to  {/}  can  be  defined  by  the  vectors,  T,  N,  and  B  as 


=  [T  N  B}. 


(III. 24) 


Let  Att  be  the  angular  velocity  of  {A}  with  respect  to  {/},  resolved  in  {A}.  It  can 
be  shown  that  ACl  is  equal  to  [t s  0  ks]T  Using  ACl  and  the  Serret-Frenet  Theorem 
[Ref.  3],  the  time  rate  of  change  of  is 

di\n)  _  d{\n). 


0  — K  0 


=  [T  N  B]  k  0  — r  s, 


0  r  0 


=  ^(An), 


where  <S(F)  is  a  skew  symmetric  matrix  defined  by  [Ref.  10], 


son  =  yx. 


0  —  KS  0 


0  —  TS 


0  TS  0 


(III.25) 
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Let  P(sq)  denote  a  point  on  the  trajectory  Pc  £  £.  Define  the  error  vector 

Me  :=  f7l(P  -  P(s0)).  (III.26) 

We  will  call  Pc(s0)  a  projection  of  P  onto  Pc  G  S  when  Me  has  the  following  form: 

Me  =  [0  y  z]T. 

From  the  definition  of  Me ,  jPcK-so)  is  also  the  point  on  Pc  nearest  to  P.  (For  the 
discussion  of  when  such  a  point  can  be  uniquely  determined,  see  [Ref.  40]).  Let 
Pc(s0)  be  the  projection  of  P  onto  Pc  €  S.  Then,  using  the  definitions  of  Me  and 
{A},  we  obtain 

d 


dt 


P  =  <brv 

=  JtFC  +  JfinME)' 


i 

0 

VA  ns{AM)ME  +a  n 

0 

y 

0 

z 

(III.27) 


Therefore, 


iRV 


fR'eRV, 


fR'An 

s 

0 

+f  #Ans{Att)ME  +f  R\n 

0 

V 

M 

0 

z 

y 

z 

s 

y 


+  s(An)ME, 


+ 


—yns 

— ZT  S 

yrs 
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(III.28) 


or 


I 

o 

o 

1 

T— 1 

1 _ 

s 

ZT  10 

y 

yr  0  1 

z 

s 

1  -  yn 

0 

0 

y 

= 

ZT 

1 

0 

z 

yr 

0 

1 

inv. 


3.  Generalized  Error  Vector 


(III. 29) 


The  design  of  an  integrated  guidance  and  control  system  for  the  plant  Q  in 
(III. 9)  and  the  set  £  involves  obtaining  linear  models  for  Q  along  the  trajectories  in 
£.  These  models  will  necessarily  be  time- varying  in  the  state  space  coordinates  used 
in  (III.9).  It  turns  out,  however,  that  an  appropriate  coordinate  system  exists  where 
the  linearization  of  the  plant  Q  along  any  trajectory  Pq  £  <f  is  time-invariant.  This 
coordinate  system  is  discussed  next.  Let  Pc,  Ac  £  £  be  given.  Define 


VE 

£Ie 
Pe 

A  E 

which  can  be  interpreted  as  the  generalized  error  vector  between  the  vehicle  state 
and  the  trajectory  in  £.  Simple  physical  considerations  show  that  the  problem  of 
following  a  trimming  trajectory  Pc  €  £  at  a  fixed  speed  Vc  is  equivalent  to  driving 
the  generalized  error  vector  to  zero. 

In  order  to  have  a  complete  description  of  the  error  dynamics,  we  need  to  derive 
an  expression  for  the  time  rate  of  change  of  the  generalized  error  vector,  (III.30). 
Expressions  (III. 9)  and  (III. 29)  suffice  to  describe  the  derivatives  of  the  first  three 
terms  in  (III. 30),  since  Vc  and  £lc  are  constant  along  trimming  trajectories.  The 


V-Vc, 
fl  —  Do?, 
s  y  z 


IT 


=  Qrx  [A  -  Ac] , 


(III.30) 
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fourth  term,  A s,  is  the  only  term  that  requires  an  explanation.  Recall, 


As  =  Q-1  [A  —  Ac] 


(III.31) 


Therefore, 


Since 


and 


dt 


d_ 

dt 


A  =  Qfl, 


(III.32) 


we  obtain 


d_ 

dt 


A  e 


^A  c  =  Qc^ci 


[A -Ac] 


(III. 33) 


Therefore,  the  generalized  error  dynamics  are  described  by  the  system  of  equations 
■^Ve  =  ^~Ve{Yei  ^Ei  As)  +  ^ve{Ve,0,e)'H(Ve,0,e.,U), 

j-t0,E  =  ^qe(Ve,CIe,A.e)  +  2ns(VB,ns)H(Vs,^B,  f^), 

i  -1 

1  —  yn  0  0 


Qe  =  < 


d  p  _ 

dt”E  ~~ 


zr 

yr 


i  o 
0  1 


£nv, 


(III. 34) 


^A  s  =  fis  —  tic  —  Q  1QcIIc,  +  Q  1QAs, 


where 


tFvE(VE,ftE,^E)  =  >?V(Vs  +  +  Oc,  QAs  +  Ac), 

and  similarly  for  1 vE,  Pqe  and  1^E. 

An  important  consequence  of  this  choice  of  error  dynamics  is  that  the  lin¬ 
earization  of  equations  III. 34  along  any  trajectory  Pc  €  £  is  time-invariant.  In  order 
to  derive  the  linearization  of  (III.34),  we  require  the  following  identity. 
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Identity  1:  Let  BR  be  the  rotation  matrix  from  {B}  to  {/},  and  let  Q  satisfy  J^(A)  = 
QCl.  Then  for  any  vector  X  in  R3 


-^CbRX)  =  -‘bRS(X)Q-\ 
fr(?RX)  =  S(fRX)Q-K 


Proof:  First  we  observe  that  [Ref.  10]: 

ffiR)  =£,  RS( n>. 

Next,  from  the  definition  of  a  cross-product  we  get 

<S(X)F  =  -5(F)X 

for  any  X,  Y  €  R3.  Now,  using  equations  III.37,  III.38,  and  the  fact 
constant  vector,  we  obtain 

f/sRX)  =  ft('BR)X+'BR±X, 

=  '„RS(  (l)X, 

=  -l;RS(x)n. 

Next,  observe  that 

ffiRX)  =  ±(>brx)±. a. 

=  ~(,BRX)Qa. 

Equation  III.35  now  follows  by  comparing  equations  III.39  and  III.40. 
To  obtain  equation  III.36  note, 


(?R) 


-i 


—  (1?^), 


(III.35) 


(III.36) 


(III.37) 


(III. 38) 
that  X  is  a 


(III. 39) 


(III.40) 
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thus 


=  -S(Q)fR.  (III. 41) 

Therefore, 

jt(?RX)  =  -S(Sl)fRX, 

=  S(fRX)  n.  (111.42) 

Moreover,  using  the  chain  rule,  it  follows  that 

jfi  RX)  = 

=  ^(fRX)en.  (IH.43) 

Equation  III.36  follows  readily  from  equations  III.42  and  III.43. 

Finally,  let  A  =  0,  then 

b*  =?  n  =  q  =  /. 

Now,  using  equations  III. 35  and  III. 36,  we  get 

3j(!«x)Ia=o  =  u=„. 

=  S(fRX)Q-\ 

=  S(X).  (III.44) 


Since  any  trajectory  Pc  €  £  defines  a  trim  condition  for  equations  III. 6  and 
III. 7,  the  linearization  of  (III. 6)  and  (III. 7)  is  naturally  time  invariant.  Introducing 
the  following  notation, 

A*  =  +&(.)«(.)], 

Bz  =  ±[JX(.)H(.)], 
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the  linearization  of  (III. 6)  and  (III.7)  is  written  as 
d 

—SVe  —  AySVE  +  A^SVIe  4*  A^SAe  +  By5U, 
d 

—SQ,e  =  AySVE  +  AqSFIe  +  Al^SAe  +  BqSU.  (III. 45) 

We  need  only  to  derive  the  expressions  for  ft6PE,  and  j~tSAE  to  show  that  they  are 
time  invariant. 

Let 


Then,  from  (III. 34), 


M  = 


1  —  yn  0  0 

ZT  10 

yr  0  1 

(1  -yn)-1  0  0 

— zt{\  —  y/t)-1  1  0 

~yr(l  -  yn)-1  0  1 


(III.46) 


jtPE  =  M(PE)in(  A)V 
=  Minv. 


(III. 47) 


Furthermore 


~[M^HV]\cSPe  +  JL-[MjKV}\c6AB  +  ~{MABn\%W 


Expanding  the  first  term  in  (III. 48),  we  obtain 


d 


dP 


E 


[Minv]  |c  = 


dM 

dP, 


E 


I  c£nvc, 


dM  | 

dM  j 

dM  | 

9P.fi,  |c 

9Pfi2  F 

9Pfi3  J 

0  0  0 
0  0  0 
0  0  0 


djl-yn)-1  . 
dy  \c 
d-zril-yn)-1  { 
dy  I 

d-yr(l-yn)^1  ■ 
dy  "  I 


cKVc , 

0  0 
0  0 
0  0 


(III. 48) 


0  0  0 

a-*T(i-v«)-i  |  n 

dz  \c  u  u 

0  0  0 


'We, 
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=  ($KVC)a 


ooo  k(£hvc)x  o  o 

ooo  o  oo 

0  0  0  —t(q'JZVc)x  o  0 

0  K  0 

0  0  — T 

0  -r  0 


0 


0  0 


-t(£KVc)x  0  0 


0 


0  0 


(III. 49) 


where  the  subscript  c  implies  that  the  preceding  gradient  is  being  evaluated  along  the 
trimming  trajectory.  The  subscript  x  implies  the  x-component  of  the  vector,  and 

r  lT 

Pe  =  PE j  Pe2  Pe2 


Now,  from  the  definition  of  AE,  it  follows  that 

dA 


dA  e 


=  Q. 


Next,  using  equation  III. 50  and  Identity  1,  we  get 

=  (m-A-Hkv ])|t, 


a 


=  W: ' • 
= 

=  -ins(vc), 


(III.50) 


(III.51) 


and 


dV 


[Mj,nv]\c 


Acn. 


By  combining  equations  (III.49  -  III.52),  we  obtain 


d_ 

dt 


8Pe  =  $KVc)x 


0  AC  0 

0  0  -r 

0  — r  0 

L  j 

%KS(Vc)8Ae  +c  K$Ve. 


SPe 


(III.52) 


(111.53) 

(111.54) 
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The  final  term,  8XE ,  is  obtained  by  observing  that,  along  the  trajectories 
PceS,  ^Q_1  =  0.  Using  simple  algebra,  we  obtain 

it6Ae  =  “e-^(s'1|Ac)  wtUSAE-  (IIL55) 

Now,  since  ^Ac  =  [0  0  ipc]T  and  from  the  definition  of  Q_1  (III.3)  and  fll  (III.2), 
it  follows  that 


a~'itAc  = 


=  fK^-Ac. 

1  dt 

Finally,  using  Identity  1  and  equations  III.50  and  III.56,  we  obtain: 


(III.56) 


d  /^-i  d  a  v  dA  .  d  /R_  d  x  , 

dA^Q  dtAch aJc  ~  M ^nJtAc^c 


=  S{fn-Ac)Q-lQ\c  =  S{Slc).  (III.57) 

The  desired  expression  for  j~t8AE  now  follows  from  expressions  III.55  and  III.57  as 


;8AE  —  8Q,E  —  S(ttc)6AE. 


(III.58) 


Summarizing,  the  linearization  of  equations  III. 34  along  any  trajectory  Pq  G  S 
is  time-invariant  and  given  by 


-£8VE  =  AySVE  +  A^8VlE  +  A\8AE  +  By8U, 
j^8SlE  =  Ay8VE  +  An8£lE  +  +  Bq8U, 

0  K  0 

&  ivc)  =  <  ft8P  =  {£nvc)x  0  0  -r  8Pe,  (III.59) 

0  — r  0 

-  £KS(Vc)6AE+£nSVE, 

$t$AE  =  8flE  —  S(Clc)8AE, 

where  (£lZVc)x  is  the  x-component  of  the  vector  ^TZVC.  In  the  next  section,  the 
symbol  Qt  will  denote  the  set  of  all  linear  plants  Q;  (j]c)  associated  with  the  set  S. 
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D.  TRAJECTORY  TRACKING  CONTROL  SYSTEM  DE¬ 
SIGN  AND  IMPLEMENTATION 
1.  Linear  Controller  Design 

In  the  previous  section,  we  have  shown  that  the  linearization  of  the  nonlin¬ 
ear  system  Qe  about  any  trajectory  in  £  results  in  a  time-invariant  plant  Qi  (t?c). 
Therefore,  associated  with  the  set  £  there  is  a  family  of  linear  plants,  Q\  .  These  can 
now  be  used  to  synthesize  a  tracking  (possibly  gain-scheduled)  controller  C  ,  which  is 
designed  to  operate  over  all  the  trajectories  in  £. 

A  common  approach  to  the  development  of  such  a  controller  C  requires  de¬ 
signing  a  family  of  linear  controllers  for  a  finite  number  of  linear  plants  in  Qi  ,  and 
then  interpolating  between  these  controllers  to  achieve  adequate  performance  for  all 
the  linearized  plants  in  Qi  .  During  real  time  operation,  the  controller  parameters  are 
updated  as  functions  of  a  gain-scheduling  variable  q  =  h(V,  Cl,  A,  P,  U,  r}c),  where  h  is  a 
C 1  function.  For  example,  a  typical  gain-scheduling  variable,  for  the  case  of  aircraft, 
is  dynamic  pressure.  In  that  case,  q  —  |p||V||2,  where  p  represents  air  density  and  is 
itself  a  function  of  aircraft  height. 

In  what  follows,  we  restrict  ourselves  to  the  idealized  case  where  the  description 
of  each  controller  for  each  plant  Q\  ( rjc )  is  available  [Ref.  39].  Therefore,  we  assume 
that  the  first  design  step  produces  the  set 

Cl  ■-={Cl{qc),qc  =  h(Vc,tlc,Ac,Pc,Ue,Tle)}, 
given  by  (see  Figure  33): 


Ci  (ge)  = 


SE 

£sxcl 


su 


[6v  Sy  Sz]T  -  [£uc  Syc  Szc]T, 

A*(qc)SXcl  +  Bcl{qc)[svT  snT  SA If 

pBC2(qc)6XC2  +  Bcs(qc)6E, 

6E, 

Ccl(qc)SXcl  +  Del (qc)[svT  snT  8AIY 
d’DC2(<2,c)£A’C2  +  Vc3(qc)SE, 


(III. 60) 
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where  6Xcl  G  Rn°,  SXc2  €  Rm  and  m  -  dim (U).  The  vector  SXc2  represents  the 
integrator  states  of  the  controller  Ct  (qc).  The  vector  6Xcl  represents  the  remaining 
states  of  the  controller  Ci  (qc).  The  velocity  and  positon  error  is 


6V 

— :  Ci  Sfl  +  C2SPE, 


0  0  0 
0  1  0 
0  0  1 


(III. 61) 


where  6vc,  Syc  and  Szc  are  introduced  to  determine  how  fast  the  error  states,  6v,  8y, 
and  6z,  go  to  zero.  We  further  assume  that  the  parameters  of  the  controller  are  C1 
functions  of  qc. 


Figure  33.  Set  of  Linear  Controllers 


The  structure  of  the  controller  C/  (qc)  has  the  following  important  feature. 
Suppose  the  closed-loop  system  consisting  of  (qc)  and  Ct  (qc)  given  by  equations 
III.59  and  III.60  is  asymptotically  stable.  Then,  for  a  given  qc,  the  controller  Ct  (qc) 
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will  ensure  zero  steady-state  error  to  a  step  input  for  the  variables  in  SE.  This  includes 
errors  in  the  vehicle’s  inertial  velocity  v,  and  in  the  deviations  from  Pc,  z  and  y.  Zero 
steady  state  errors  are  achieved  by  integrating  SE.  This  structure  is  typical  of  tracking 
controllers,  since  they  are  designed  to  drive  errors  between  step  changes  in  reference 
commands  and  the  corresponding  plant  outputs  to  zero  in  steady  state.  Notice  that 
the  block  JC(qc )  (see  Figure  33)  may  itself  contain  additional  integrators. 

2.  Gain  Scheduled  Controller  Design 

Next,  the  family  of  linear  controllers  Ci  (qc)  must  be  implemented  on  the  non¬ 
linear  plant  Q  defined  in  Section  B.  This  problem  has  been  addressed  in  [Ref.  27] 
for  the  general  class  of  nonlinear  plants  and  for  tracking  controllers  with  the  same 
structure  as  C\  (qc)-  In  [Ref.  27],  the  authors  formulated  a  so-called  controller  imple¬ 
mentation  problem  which  will  be  repeated  here  for  the  problem  at  hand. 

Let  T(Qi  (qc),  Ci  (qc))  be  the  closed-loop  linear  system  that  results  from  con¬ 
necting  Ci  (qc)  to  Qi  (qc),  and  denote  by  T{Qi  (qc),  Ci  (qc))  the  corresponding  matrix 
transfer  function.  Let  E(Q  ,  C  )(qc)  be  the  nonlinear  closed-loop  system  that  consists 
of  C  and  Q  ,  and  let  T\{Q  ,  C  ){qc)  denote  its  linearization  about  Pc  G  £,  and  denote 
by  Ti(Q  ,  C  )(qc)  the  corresponding  matrix  transfer  function.  With  this  notation,  the 
controller  implementation  problem  applied  to  the  integrated  guidance  and  control 
problem  considered  in  this  chapter  can  be  stated  as  follows: 

Controller  implementation  problem:  “Find  a  gain  scheduled  controller 

C  such  that  for  each  trajectory  Pc  G  £ 

1.  the  feedback  systems  Ti(Q  ,  C  )(qc)  and  T(£,  ( qc ),  Ci  ( qc ))  have  the  same 
closed-loop  eigenvalues. 

2.  The  closed-loop  transfer  functions  Tt(Q  ,  C  )(qc)  and  T(Ql  (qc),  C\  (qc))  are 
’’equal.” 

Given  the  set  C,  of  linear  controllers  for  the  set  Qt  of  linearized  plant  models, 
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we  propose  the  following  structure  for  the  gain  scheduled  controller  C  (see  Figure  34): 

[0  y  z]T  =  fK(P  -  Pc(3„)), 

E  =  [v  -  vc  y  -  yc  z  -  zc]T) 

&xcl  =  ACI(q)Xa  +  Bcl(q)[j-tVT  (!)  -  S-'Acf F 

+B,-Aq)E  +  (111.62) 

T.X.2  =  Ccl(q)xcl  +  vcl(q)ii V*  inT  (n-Q-'kcf)T 

+Vc2(q)E  +  Vc3(q)±E, 

u  =  jrs2. 

Recall,  Pc(sq)  is  the  projection  of  P  onto  the  helix  Pc  <E  £.  Comparison  of  Figure  33 
and  Figure  34  indicates  that  the  structure  of  the  gain  scheduled  controller  is  easily 
obtained  from  that  of  the  linear  controllers. 


Figure  34.  Gain  Scheduled  Controller 


We  now  make  the  following  assumptions: 

Al.  Dim(Xc2)  =  dim(i/)  =  dim (E) 

A2.  The  matrix 

si  —  Aci(q)  BC2(q) 
~Ca(q)  P>c2(q) 
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has  full  rank  at  s  =  0  for  each  Pc  €  E. 

A3.  The  matrix  pair  (Ac\,Cc\)  is  observable. 

Assumption  A1  implies  that  the  number  of  integrators  is  equal  to  the  number  of 
control  inputs.  This  is  necessary  if  the  controller  is  to  provide  independent  control  of 
the  errors  E  using  the  control  inputs  U.  Assumption  A2  implies  that  the  realization 
(Ac1,Bc2,Cc1,Vc2)  has  no  transmission  zeroes  at  the  origin.  Finally,  assumption  A3 
guarantees  that  the  state  Xc\  is  zero  along  the  trajectories  in  E. 

The  main  result  of  this  section  is  stated  next. 

Theorem  D.l  Suppose  assumptions  Al,  A2  hold.  Then  the  gain  scheduled  controller 
C  given  by  equations  III.  62  solves  the  controller  implementation  problem ,  i.e.,  for  each 
Pc  €  E  the  following  properties  hold: 

1.  The  feedback  systems  T ]{Q  ,  C  )(qc)  and  T(Qi  ( qc ),  C/  (gc))  have  the  same 
closed-loop  eigenvalues. 

2.  The  closed- loop  matrix  transfer  functions  T\(Q  ,  C  )(<7c)(s)  and  T{Qi  (qc),  C\  (qc))(s) 
are  equal. 


Proof:  In  the  proof,  we  set  the  controller  matrices  Dcl,  Pc3  to  zero.  This  does  not 
change  the  results  but  considerably  simplifies  the  algebra. 

Let  Pc  €  E  be  given.  Let 


- 1 

Ai 

A  ^  A* 

0  /  -S(llc) 

A*i  := 

o 

- cKS(Vc ), 

0  K  0 

A3  :=  $nVc)x 

0  0  -r 

0  — r  0 
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B  := 


(iKVc),  := 


ST  := 


Bv 
Bn 
0 

^-component  of  qIZVc 
6Ve  1 
SCIe 
SAe 


Then,  (III.59)  is  expressed  as 


4<nr  = 


i 


Axtrc  +  BSU, 
A26T  +  A36P. 


Si  (vc)  =  1  dt 

The  error  signal  is  expressed  as 

se  =  CiSr  +  CiSP, 

which,  when  substituted  into  the  linear  controller  (III.60),  results  in 


(III.  63) 


(III. 64) 


Cl  (9c)  = 


&Xe  2 


(III. 65) 


SX*  —  Aci(qc)SXci  +  Bc2 SXc2  +  [Bci(<jc)  T  Bc;i,((]c)Cj]  S~T 
-\-Bcs(qc)C26P, 

c1sr  +  c28p, 

SU  =  Ccl(qc)6XclVc2(qc)6Xc2. 

Consider  the  feedback  interconnection  of  the  linear  plant  (III.63)  and  linear 
controller  (III. 65).  The  state  matrix  F  of  this  feedback  system  has  the  following  form: 


F:= 


A1 

BVc3C1 

BCc\ 

bvc2 

CO 

0 

0 

Bci  +  B^Ci 

Bc3C2 

Ac  1 

BC2 

Ci 

C2 

0 

0 

(III.66) 


Next,  we  linearize  the  feedback  interconnection  of  the  plant  Q  and  the  con¬ 
troller  C  .  However,  in  order  to  do  that,  first  we  must  determine  the  values  of  the 
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controller  states  Xcl  and  Xc2  along  the  trajectory  Pc  G  S.  From  equation  III.62,  we 
obtain: 


Jtx* 1,  =  + Bcl(qc){^vJ  jtaTc  (nc  -  ea'Acff 

+^c2 (<lc)E  +  Qc )  ^  ! 

d 

~faXc2c  —  Cci(qc)Xclc+Vc2(qc)E, 

Uc  =  xc2c.  (III. 67) 

Notice,  since  along  Pc  G  £'■ 


we  get 


E 

Vc 

Clc 

—  Qc^'kc 


X, 


c2c 


0, 

constant, 

constant, 

0, 

Uc,  a  constant, 


(III.68) 


d 


0 


AclXcU, 

CclXclc. 


Now,  using  Assumption  A3,  we  conclude  that 


*cic  =  0.  (III. 69) 

In  order  to  compute  the  linearization  of  the  feedback  interconnection  of  Q 
and  C  (T(Q  ,C  ))  along  Pc  G  £,  first  observe  that  P(Q  ,C  )  is  equal  to  the  feedback 
interconnection  of  QE  and  the  system  consisting  of  JC(q)  and  the  integrator  Xc2.  The 
linearization  of  QE  along  Pc  G  £  is  given  by  (III.59).  The  linearization  of  the  system 
consisting  of  K(q)  and  Xc2  can  be  obtained  using  the  trimming  values  of  Xcl  and  Xc2. 
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Define 


0  := 


dt 


— 

m  := 


ivg  inTE  (Ji-e-AcF 


l  T 


yT  yT  ±n  r?T  d_  pT  „ 

^cl  ^c2  dt®  ^  dt ^ 


then,  along  Pc 


Wn 


0  U?  o  0  0  «„ 

and  the  linearization  of  (III.67)  can  be  written  as 


i  T 


(III. 70) 


d  fix  -  d(Acl(gc)Xclc).  d{Bci{qc)jt6 {  d{Bc2(qc)E) 
dtcU  ~  fa  ko  +  fa  l-o  + - fa - 


dm 

WxM&E), 

dm 


1070 


1^0  5 


isv  _  d(Ca(qc)XcU) 

itbX°2‘  da 

a,  _  9(Xe%) 

o  |G7o* 


^0 


.  9(p ME), 

da 


dm 

Consider  the  expansion  of  the  first  term  in  (III.71), 
d(Acl(qc)Xclc). 


dm 


l®0 


d(Aci(qe)XeU)  d{Acl(qc)Xcl) 
l^o  '  ' 


dXcl 

d(Acl(qc)Xclc) 


dX, 


c2 


(III. 71) 


d(ACI(qc)XcU) 

|roo+  m  K 


dE 

Acl(qC0)6Xclc. 


-\wq  +  dMcl(gc)-Xcle)  ^(^el(ge)^ele) 


dE 


dqc 


iO70  1 


(III.72) 


Since  Xclc  is  zero  along  the  trajectory,  their  are  no  extra  terms  due  to  the  scheduling 
parameter,  qc.  Similar  results  are  obtained  for  the  terms  Bcl(qc),  Ccl(qc),  and  Vc2{qc). 
Noting  that 

d 


s^eT  = 

dt 


pvl  ami 


the  linearization  of  (III.67)  has  the  following  form: 

jt8XcU  =  Acl8Xclc  +BcX[jt8V%  ~mTE  jt8ATE]T  +  Bc28E  +  Bc3jt8E, 


d_ 

dt 


8XC 2  —  Cc\8Xc\c  +  Vc28E, 
8U  =  8Xc2c. 


(III.73) 
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The  state  matrix  M  of  %{Q  ,  C)  is  calculated  as 


The  proof  of  the  first  part  of  the  theorem  can  now  be  shown  by  following  the  proof 
of  Theorem  4.1  in  [Ref.  27].  From  Assumption  A2,  it  follows  that  the  matrix 

Ac\  Bc2 
Bci  'Dei 

is  invertible.  Therefore,  we  will  use  this  to  define  a  very  useful  similarity  transforma¬ 
tion  to  show  that  F  and  M  have  the  same  the  eigenvalues.  Let 


1  -l  r 

Acl  Bc2  _  X  Y 
Cel  Vc2\  [Z  W 

and  set 


(III.  74) 


I 

T  ,=  ~x[bc  1  bc3 

~Z  [  Bel  Bc3 

Expression  III.74  implies 


/  0 


Ci  c2 


0  0 
X  Y 

Z  W 


(III. 75) 


AC\X  +  Bc2  =  7, 

Cel  y  +  T>c 2  =  I , 

Ac\Y  +  Bc  2  =  0, 

CclX- \-Vc2  =  0.  (III.  76) 
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A  simple  computation  using  (III. 76)  and  (III.75)  verifies  that 


T~ 1  := 


Bcl  Bc3 


I  0 
C\  C2 


0 


0  0 
X  Y 

Z  W 


(III. 77) 


and  that  F  —  TMT  1 .  Thus,  F  and  M  have  the  same  the  eigenvalues. 

In  order  to  prove  the  second  part  of  the  theorem,  it  will  suffice  to  show  that 
the  linear  controllers  (III.73)  and  (III.60)  have  the  same  transfer  function  from 


E  = 


8v  8y  8z 


8vc  8yc  8zc 


and 


0 


8VT  8nT  8AT 


(III.78) 


to  8U.  A  direct  calculation  of  the 


Laplace  transforms  show  that 


U(s) 


Cci(sl  —  Ad)  1 


8VT(s )  8nT(s ) 


|  Bc2E(s) 
s 

|  VczEjs) 
s 


+  Bc3E(s)  j  +  Dcx 
+  T>c3E(s ), 


dyT(s) 


^at(5)  j 

8QT(s)  8AT(s) 

(III.79) 


for  both  controllers.  B 

Thus,  the  eigenvalues  of  the  linearizations  along  each  trajectory  in  £  are  pre¬ 
served.  Furthermore,  the  input-output  behavior  of  the  linearized  operators  is  pre¬ 
served  in  a  well-defined  sense.  The  reader  is  referred  to  [Ref.  27]  for  a  complete 
discussion  on  approximations  to  this  method  that  avoid  using  pure  differentiation. 

3.  Implementation  Procedure 

The  Theorem  D.l  can  be  used  as  follows:  first,  determine  the  dynamics  of 
the  vehicle  Q  and  the  set  of  trimming  trajectories  £  the  vehicle  is  required  to  track. 
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This  set  is  parameterized  by  the  range  of  trimming  velocities  ( vc ),  desired  flight 
path  angles  (7C),  and  desired  heading  rates  (ipc).  Recall,  these  variable  constitute 
a  gain-scheduling  vector  qc  =  [vc  7 c  V>C]T.  Next,  rewrite  the  vehicle  dynamics 
using  generalized  error  coordinates  Ve,  U#,  A e,  and  Pe  to  obtain  the  vehicle’s  error 
dynamics  Qe •  Linearize  Qe  about  a  finite  number  of  trajectories  in  £.  Use  these  linear 
models  to  design  a  finite  number  ( k )  of  trajectory  tracking  controllers  {C;  i  =  1,  k}. 
Gain  schedule  {Ci  i,i  =  1,  k}  utilizing  a  favorite  interpolation  or  gain-scheduling 
technique  to  obtain  the  linear  gain-scheduled  controller  C\  (qc).  Now,  implement  this 
controller  on  the  nonlinear  plant  Q  according  to  the  expression  III. 62. 

It  is  worth  emphasizing  the  following  important  properties  of  the  controller  C  : 

•  The  result  in  Theorem  D.l  holds  for  all  trajectories  in  S. 

•  The  structure  of  the  controller  C  is  easily  obtained  from  that  of  the  linear 
controllers. 

•  Since  all  the  closed-loop  transfer  functions  of  the  local  linearizations  are  pre¬ 
served,  at  the  level  of  local  linear  analysis,  the  controller  does  not  introduce 
any  additional  noise  amplification  despite  the  presence  of  a  differentiation  op¬ 
erator. 

•  Along  trajectories  Pc  <E  £,  Xc2c  =  Uc  and  Xclc  =  0.  Therefore,  the  trimming 
values  of  the  control  inputs  are  naturally  provided  by  the  integrator  block  with 
state  Xc2c, 

•  The  integrators  Xc2  are  directly  at  the  input  of  the  plant,  which  makes  it 
straightforward  to  implement  anti-windup  schemes.  This  becomes  necessary 
in  applications  where  the  input  U  is  hard  limited  due  to  actuator  saturation, 
for  example. 

•  The  inputs  to  the  controller,  Pc  and  Ac,  can  be  computed  directly  from  the 
vector  qc. 

•  The  trim  values  Vc,Oc,  and  Uc  are  not  required  in  the  controller  implemen¬ 
tation. 

•  Along  the  trajectories  Pc  €  S ,  the  controller  guarantees  that  the  steady  state 
value  of  error  vector  E  is  zero,  which  follows  from  the  fact  that  the  controller 
solves  the  controller  implementation  problem.  This  is  in  sharp  contrast  to 
standard  LOS  guidance  schemes. 
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E.  EXAMPLE 


In  this  section  we  apply  the  methodology  developed  in  Section  D  to  the  design 
and  implementation  of  an  integrated  guidance  and  control  system  for  a  fixed  wing 
unmanned  air  vehicle.  The  vehicle’s  stability  and  control  derivatives  are  the  subject 
of  a  section  of  chapter  IV.  Using  the  notation  in  Section  B,  the  Frog  dynamics  have 
the  following  form: 

r  ftv  =*v(v,n,A)  +  iv(v,n)'H(vt(itu)t 
g  =  \in  =Mv,n,\)  +  Mv,n)H(v,s i,u), 
iP  =bKV, 

.  ft  A  =  QSl. 

Following  the  development  in  Section  B,  the  set  of  trimming  trajectories  £  for 
the  vehicle  is  defined  as  follows: 


i  Pc  =b  nvc, 

ft  Ac  =  Qc  £tc, 

Fv(Vc,  nc,  Ac)  +  Iv(Vc ,  nc)H(Vc,  He,  Ue)  =  0, 
fn{Vc,  nc,  Ac)  +  lsi(Vc,Slc)H(Vc,  Sla,  Ue)  =  0, 

(III.81) 

where  Pc  and  Ac  can  be  computed  using  the  scheduling  vector  q  =  [vc  fc]T. 

Now,  given  [vc  ipc]T  and  pe  =  0,  we  can  solve  for  Vc,Slc,Uc,  and  Ac\ 


Pc 

Ac 


^v(Vcr,ftc,Ac)  +  MVc,nc)H(Vc,Slc,Uc)  =  0, 

^h(Vc,ftc,Ac)  +  MVc,£lc)n(Vc,Slc,Uc)  =  0, 

QcXSlc  —  Ac  =  0 

II  be  ||  —  wc  =  0, 

A  -  sin"1  £  =  0, 

Vt 

7c -[0  1  0]  arg(%llfn)  =  0,  (III.82) 

where  the  arg  function  extracts  the  angles  X  from  the  rotation  matrix  K{X):  X  = 
arg(Tl{X)). 
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Using  the  solution  to  equations  III.82,  the  linear  model  for  the  vehicle  rep¬ 
resented  by  equations  III.59  was  obtained  along  a  trajectory  characterized  by  the 
velocity  of  73  feet  per  second,  flight  path  angle  of  zero,  and  heading  rate  of  10  degrees 
per  second.  This  model  was  used  to  design  a  linear  trajectory  tracking  controller  for 
the  vehicle. 

1.  Design  Requirements  and  Linear  Controller  De¬ 
sign 

Design  requirements  for  the  linear  trajectory  tracking  controller  included 

•  Zero  Steady  State  Error:  Achieve  zero  steady  state  tracking  errors  of  all 
trajectories  in  S.  Achieve  zero  steady  state  tracking  error  of  indicated  airspeed 
while  on  any  trajectory  in  S. 

•  Bandwidth  Requirements:  The  command-loop  bandwidth  for  each  com¬ 
mand  channel  should  be  no  greater  than  1  radian  per  second  and  no  less  than 
1/10  radian  per  second;  the  control-loop  bandwidth  should  not  exceed  12  ra¬ 
dians  per  second  for  the  elevator,  aileron  and  rudder  loops,  and  5  radians  per 
second  for  the  throttle  loop.  These  numbers  represent  50%  of  the  correspond¬ 
ing  actuator  bandwidths,  and  shall  ensure  that  the  actuators  are  not  driven 
beyond  their  linear  operating  range. 

•  Closed  Loop  Damping  and  Stability  Margins:  The  dominant  closed- 
loop  eigenvalues  should  have  a  damping  ratio  of  at  least  0.5.  Simultaneous 
gain  and  phase  margins  of  6db  and  45  degrees  in  each  control  loop  must  be 
achieved. 

The  methodology  selected  for  linear  control  system  design  was  /H00  synthe¬ 
sis  [Ref.  12].  This  method  rests  on  a  firm  theoretical  basis,  and  leads  naturally  to 
an  interpretation  of  control  design  specifications  in  the  frequency  domain.  Further¬ 
more,  it  provides  clear  guidelines  for  the  design  of  controllers  so  as  to  achieve  robust 
performance  in  the  presence  of  plant  uncertainty.  The  basic  steps  in  the  controller- 
design  procedure,  including  the  development  of  the  synthesis  model,  were  done  us- 
ing  the  approach  described  in  [Ref.  24].  This  approach  provides  an  intuitive  and 
straightforward  way  for  converting  the  design  requirements  into  the  weights  for  the 
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Hoo  synthesis  model.  Consider  Figure  35.  Here  Ci  is  the  controller  to  be  designed, 
Qi  is  the  linear  model  of  the  vehicle. 


Figure  35.  Synthesis  Model 


In  Figure  35,  the  vector  of  exogenous  inputs  w  represents  the  commanded 
inputs.  The  vector  represents  lateral  and  vertical  displacement  states  of  the  linear 
model  as  well  as  the  vehicle’s  velocity.  The  regulated  output  z  includes  the  outputs 
of  the  weighting  matrices  Wx  and  W2.  These  matrices  had  the  following  form: 

^00 

S 

Wi  =  o  f  0  , 

0  0^ 

s 

c4  0  0 

0  c5  0  ,  (III.83) 

0  0  C6 

where  the  constants  c, ,  i  =  1,6  were  used  as  the  design  knobs  adjusted  to  meet  the 
closed-loop  tracking,  damping,  control,  and  command  loop  bandwidth  requirements. 
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Values  of  W\  and  W2  were  iterated  on,  and  used  to  obtain  a  linear  trajectory 
tracking  controller: 

SE  =  [8v  8y  8z]T-[8vc  8yc  8zc]T, 

£8Xe  1  =Ac18Xc1+Bc18Xc2, 

pXc2  =  8E , 

8U  =  qf{Ccl8Xcl  +  T>ci  [8VT  8ttT  8ATE}T  +  Vc28Xc2  +  Vc38E}, 
where  the  'H00  state-feedback  gain  is  1C  =  [Cc  1  T>cl  Vc2  Vc3].  The  feedback  system 
consisting  of  the  plant  Qi  and  the  controller  C\  was  found  to  meet  all  the  design 
specifications  given  earlier  in  this  section.  Since  the  control  surface  effectiveness  is 
proportional  to  the  dynamic  pressure,  the  controller  Ci  was  gain-scheduled  on  q. 

The  value  qo  represents  the  nominal  value  of  q. 

2.  Implementation  and  Simulation  Results 

Using  the  formulae  provided  in  Section  D,  the  family  of  linear  gain-scheduled 
controllers  Ci  (q)  was  implemented  on  the  nonlinear  plant  Q  as  follows: 

[0  y  z]'  H(P  -  Pc(s 0)), 

E  ={v-vc  y  z], 

Xcl  =  Ac\Xcx  +  Bc2E, 

X*  =  t {CciXci  +  ■Dcl[iiVr  a  -  Q-'(A)$AclT  +  v^e + vc2b}, 

u  =  xc2. 

We  emphasize  that  the  implementation  equations  for  the  controller  C  do  not  require 
the  computation  of  Uc  and  Vc.  Moreover,  since  ~kc  =  [0  0  tpc]T,  the  controller 
must  only  be  provided  with  ipc  and  Pc  when  steering  the  aircraft  along  the  trajectory. 
These  are  the  critical  advantages  of  the  proposed  methodology.  The  acceleration 
term  ftV  can  be  computed  using  onboard  sensors  without  resorting  to  differentiation. 
Therefore,  the  only  term  which  could  not  be  computed  directly  was  In  this  case, 
the  differentiation  operator  ^  was  replaced  by  a  causal  operator  with  the  transfer 
function  [Ref.  27]. 
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The  trajectory  tracking  controller  developed  above  was  tested  using  a  number 
of  trajectories.  One  such  trajectory  consisted  of  a  straight  line  transitioning  into  a 
helix  shown  in  Figure  36.  This  trajectory  is  characterized  by  a  cruise  velocity  of  73 
feet  per  second.  Initially,  the  trajectory  is  aligned  with  the  inertial  x-axis.  After 
proceeding  along  the  x  axis  for  3000  feet,  the  trajectory  turns  into  a  helix  with  a 
radius  of  1000  feet  and  climb  angle  of  5  degrees.  Consider  Figure  37,  which  shows 
the  time  history  of  the  position  error,  bank  and  pitch  angles,  and  indicated  airspeed 
along  the  trajectory.  Clearly,  the  controller  drives  the  vehicle  along  this  trajectory 
with  zero  steady  state  position  errors  while  maintaining  73  fps  indicated  airspeed. 


Figure  36.  The  trajectory  tracked  in  simulation. 


F.  CONCLUSIONS 

A  new  method  was  introduced  for  designing  and  implementing  integrated  guid¬ 
ance  and  control  systems  for  autonomous  vehicles.  The  starting  point  is  a  family  of 
linear  controllers  with  integral  action  designed  for  linearizations  of  the  nonlinear  equa¬ 
tions  of  motion  described  in  an  appropriate  state  space.  Based  on  this  family,  the 
method  produces  a  gain  scheduled  controller  that  preserves  the  input-output  proper- 
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Magnitude  of  Position  Error  Bank  Angle 


Time  -seconds  Time  -seconds 

Figure  37.  Time  history  of  position  errors,  Euler  angles  and  airspeed  along  the 
trajectory. 

ties  of  the  original  linear  closed-loop  systems  as  well  as  the  closed-loop  eigenvalues. 
The  key  feature  of  the  method  is  the  ability  to  automatically  reconfigure  the  control 
inputs  of  the  vehicle  to  provide  for  proper  control  action  as  the  body  tracks  an  inertial 
trajectory  in  free  space  while  maintaining  constant  airspeed.  The  method  is  simple 
to  apply  and  leads  to  a  nonlinear  controller  with  a  structure  similar  to  that  of  the 
original  linear  design. 
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IV.  RAPID  PROTOTYPING  SYSTEM  FOR 
FLIGHT  TEST  OF  AN  UAV 

A.  INTRODUCTION 

This  chapter  describes  the  development  of  a  rapid  prototyping  system  for  flight 
testing  of  guidance,  navigation,  and  control  algorithms  for  unmanned  air  vehicles.  The 
system  affords  a  small  team  the  ability  to  take  a  new  concept  in  guidance,  navigation, 
and  control  from  initial  conception  to  flight  test.  In  order  to  do  this,  a  number 
of  engineering  problems  had  to  be  overcome  addressing  a  gamut  of  issues  including 
weight,  power,  portability,  risk,  electronic  interference,  vibration,  manpower,  etc.  The 
main  contribution  of  the  project  is  the  proof  of  concept  flight  test  demonstration  of  a 
new  integrated  guidance  and  control  algorithm  (see  Chapter  III).  The  success  of  this 
endeavor  had  a  synergistic  effect  on  several  other  projects,  paving  the  way  for  joint 
ventures  in  voice  controlled  flight,  coastal  mapping,  and  autonomous  landing.  The 
project  is  viewed  as  the  foundation  of  a  long-term  investment  in  innovative  unmanned 
air  vehicle  applications  leveraging,  in  part,  the  operational  experience  of  the  officer 
students  in  the  avionics  curriculum. 

Testing  of  a  new  algorithm,  sensor  package,  vehicle,  etc.,  requires  expertise 
from  many  branches  of  the  engineering  sciences,  especially  aeronautic,  electrical,  and 
computer.  It  is  potentially  costly  and  time  consuming,  as  well  as  having  the  potential 
for  catastrophic  failure.  When  successfully  done,  however,  it  provides  developmental 
information,  insight  and  data  that  are  unavailable  from  other  sources.  All  of  our 
theoretical  and  numerical  results  must  be  verified  by  some  form  of  experiment,  and 
flight  testing  is  often  the  best  way  to  do  this. 

The  chapter  begins  with  a  conceptual  discussion  of  the  Rapid  Flight  Test  Pro¬ 
totyping  System  (RFTPS).  Motivation  for  its  development  is  addressed.  Next,  a 
description  of  the  hardware  components  is  given.  The  main  contribution  of  the  chap¬ 
ter  is  discussed  in  the  last  section,  where  an  application  of  the  RFTPS  to  the  problem 
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of  integrated  guidance  and  control  introduced  in  Chapter  III  is  presented.  The  full 
capabilities  of  the  RFTPS  are  demonstrated  when  this  novel  guidance  algorithm  is 
taken  from  theoretical  development  to  flight  test. 

B.  SYSTEM  DESCRIPTION 

The  RFTPS  consists  of  a  test  bed  unmanned  air  vehicle  equipped  with  a  com¬ 
plete  avionics  suite  necessary  for  an  autonomous  flight  as  shown  in  Figure  38,  and  of 
a  ground  station  responsible  for  flight  control  of  the  UAV  and  flight  data  collection  as 
shown  in  Figure  39.  A  functional  block  diagram  of  the  RFTPS  is  shown  in  Figure  40. 
The  key  goal  was  to  use  off-the  shelf-technology  as  much  as  possible,  thus  exploiting 
the  economy  of  scale  of  a  number  of  commercial  industries.  Furthermore,  if  the  UAV 
development  program  is  to  span  many  years,  and  to  draw  on  the  talents  of  the  officer 
students  in  the  future,  the  RFTPS  had  to  emphasize  high  level  algorithm  design.  Low 
level  code  and  device  driver  generation  is  kept  to  a  minimum  with  the  vast  majority 
of  the  code  ’’writing”  being  done  via  autocode  tools.  The  system  architecture  is  open, 
providing  the  ability  to  add,  remove  or  change  real  time  input/output  (I/O).  Compu¬ 
tational  power  can  be  increased  as  mission  requirements  dictate.  The  telemetry  links 
are  secure,  yet  low  power  and  unobtrusive  to  the  public,  not  requiring  advance  per¬ 
mission  for  use,  special  frequencies  from  a  government  authority,  or  special  airspace. 
The  onboard  components  are  light  weight  and  low  power,  allowing  for  the  inclusion 
of  additional  payload. 

1.  RFTPS  Capabilities 

The  RFTPS  developed  provides  the  following  capabilities. 

•  Within  the  RFTPS  environment,  one  can  synthesize,  analyze  and  simulate 
guidance,  navigation,  control,  and  mission  management  algorithms  using  a 
high  level  development  language.  The  same  code  that  ran  the  simulation,  flies 
the  vehicle. 

•  Algorithms  are  seamlessly  moved  from  the  high  level  design  and  simulation 
environment  to  the  real  time  processor. 
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Figure  38.  Frog :  The  unmanned  air  vehicle  at  the  Naval  Postgraduate  School. 


•  The  RFTPS  utilizes  industry  standard  I/O  including  digital  to  analog,  analog 
to  digital,  serial,  and  pulse  width  modulation  capabilities. 

•  The  RFTPS  is  portable,  easily  fitting  in  a  car.  In  general,  testing  will  occur 
at  fields  away  from  the  immediate  vicinity  of  the  Naval  Postgraduate  School. 

•  The  unmanned  air  vehicle  can  be  flown  manually,  autonomously,  or  using  a 
combination  of  the  two.  For  instance,  automatic  control  of  the  lateral  axis  can 
be  tested  while  the  elevator  and  throttle  are  controlled  manually. 

•  All  I/O  and  internal  algorithm  variables  can  be  monitored,  collected  and  an¬ 
alyzed  within  the  RFTPS  environment. 

2.  Cost,  Safety  and  Other  Considerations 

Cost  and  risk  are  two  leading,  and  at  times  competing,  concerns  that  had  to 
be  effectively  handled.  Since  initial  testing  is  to  occur  within  line  of  sight  at  all  times, 
a  pulse  width  modulated  (PWM)  remote  control  system  manufactured  by  Futaba  was 
chosen.  Testing  of  a  new  control  algorithm  is  similar  to  handing  over  control  of  the 
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Figure  39.  The  base  station  of  the  RFTPS  in  use  at  the  airfield. 


aircraft  to  a  student  pilot.  The  algorithm  should  have  full  freedom  to  perform,  yet 
adequate  safeguards  must  exist  in  case  it  fails.  With  some  modifications,  the  extensive 
master-slave  flight  training  capabilities  built  in  to  the  existing  RC  transmitters  were 
exploited.  A  significant  portion  of  the  cost  of  the  RFTPS  resides  in  the  real  time 
processor,  I/O  board  and  modules,  and  in  the  host  computer.  Additionally,  while 
compact,  the  weight  and  power  requirements  of  these  components  are  significant 
when  compared  to  onboard  power  and  payload  available.  In  order  to  gain  additional 
payload,  and  in  order  to  manage  the  risk  associated  with  the  loss  of  an  expensive 
computer  package,  the  real  time  controller  was  kept  on  the  ground.  Sensor  and 
control  links  to  the  real  time  controller  were  bridged  via  RF  components  described 
later. 


UAV 


Base 


Figure  40.  RFTPS  Hardware  Architecture 


3.  Components 

The  centerpiece  of  the  RFTPS  ground  station  is  the  AC100/C30  system  from 
Integrated  Systems  Incorporated.  The  key  feature  of  this  product  is  its  autocode 
tools.  With  a  relatively  short  time  available  for  research  by  the  officer  students,  em¬ 
phasis  had  to  be  shifted  from  code  writing,  debugging  and  maintenance  to  algorithm 
development.  AC100/C30  utilizes  ”Xmath/SystemBuild”,  a  graphical  programming 
environment  that  uses  a  high  level  block  diagram  paradigm  for  modeling  of  linear 
and  nonlinear  systems.  Within  the  ’’Xmath/SystemBuild”  environment,  the  algo¬ 
rithm  can  be  built,  simulated,  tested,  and  debugged.  Real-time  code  can  then  be 
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generated  for  execution  on  the  real  time  processor. 

Currently,  the  ’’Xmath/SystemBuild”  environment  resides  on  a  Sun  worksta¬ 
tion.  PC’s  running  Windows  NT  are  also  supported.  This  allows  for  a  significant 
downsizing  of  the  ground  station  should  resources  become  available  in  the  future. 
Communication  with  the  real  time  processor  is  via  an  Ethernet  bus  using  TCP /IP 
protocol.  AC100/C30  provides  excellent  animation  tools  for  building  graphical  user 
interfaces  (GUI).  Through  the  appropriate  design  of  these  interfaces,  the  flight  test 
team  can  monitor,  modify  ,and  control  the  actions  of  the  real  time  processor.  The 
GUI  resides  on  the  workstation.  Communication  between  the  workstation  and  the 
real  time  processor  is  via  the  Ethernet  connection,  and  is  managed  by  a  host  PC.  Ad¬ 
ditionally,  the  host  PC  provides  power  to  the  real  time  processor,  as  well  as  providing 
utilities  for  compiling,  linking,  and  downloading  the  C-code. 

The  I/O  consists  of  four  multi-mode,  bi-directional,  serial  ports  utilizing  RS- 
232  protocol,  a  16  channel  pulse  width  modulation  port  capable  of  measuring  up  to 
sixteen  PWM  signals  or  generating  up  to  six  PAA^hd  signals,  and  a  six  channel  digital- 
to- analog  converter.  The  I/O  modules  are  hosted  by  the  same  PC  that  holds  the 
real  time  processor.  The  real  time  processor  is  a  single  Texas  Instruments  Digital 
Signal  Processor  (TMS320C30).  The  capability  exists  for  upgrading  the  processor, 
or  running  multiple  processors,  to  meet  computational  demands  of  future  projects. 

The  control  configuration  of  the  air  vehicle  is  conventional  with  three  indepen¬ 
dent  surfaces  (elevator,  aileron,  rudder)  and  a  throttle.  Manual  control  is  provided 
via  a  Futaba,  dual  conversion,  PWM  transmitter  utilizing  the  portion  of  the  radio 
spectrum  reserved  for  Radio  Controlled  (RC)  flight,  72.030  MHz  to  72.990  MHz. 
Precautions  entail  a  search  of  the  electronic  spectrum  utilizing  a  hand  held  spectrum 
analyzer,  as  well  as  standard  procedures  employed  by  RC  hobbyists  to  avoid  two  in¬ 
dividuals  selecting  the  same  frequency  locally.  Built  in  capabilities  of  the  transmitter 
include  the  ability  to  transmit  one  or  more  signals  from  a  slave  transmitter.  The 
slave  transmitter  is  a  modified  Futaba  transmitter  where  the  manual  control  effectors 
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have  been  replaced  by  a  direct  connection  to  the  digital-to-analog  I/O  module.  In 
this  way,  an  exogenous  source  (RFTPS)  can  be  given  control  of  one,  some,  or  all  of 
the  control  actuators  of  the  aircraft  using  the  same  RC  link  currently  controlling  the 
aircraft. 

The  sensor  suite  onboard  the  air  vehicle  consists  of  an  inertial  measurement 
unit  (IMU)  with  a  three  axis  rate  gyro,  three  axis  accelerometer,  magnetic  heading 
indicator,  two  axis  pendulum,  phase  differential  GPS  receiver,  elevator,  aileron,  and 
rudder  actuator  position  sensors,  and  angle  of  attack,  side-slip  angle,  pitot-static,  and 
static  pressure  air  data  sensors.  A  four  channel  analog-to-digital  converter  is  used  to 
capture  any  four  of  the  following  sensors:  elevator,  aileron,  rudder  actuator  position, 
angle  of  attack,  side-slip  angle,  dynamic  pressure,  or  static  pressure. 

Communication  between  the  sensors  and  the  real  time  processor  is  via  a  serial 
link.  Low  power,  matched,  spread  spectrum  RF  links  provide  up  to  115  Kbaud  rates 
at  over  10  miles  range.  They  require  no  license,  and  can  be  used  anywhere  in  the 
United  States.  Additionally,  the  onboard  GPS  unit  maintains  contact  via  a  serial  link 
with  a  GPS  receiver  on  the  ground,  which  provides  differential  corrections. 

Power  for  the  onboard  avionics  is  supplied  from  a  lithium-ion  battery.  The 
battery  provides  6  hours  of  continuous  use.  The  power  budget  of  the  onboard  com¬ 
ponents  is  shown  in  Table  III. 


Voltage 

Current 

Power 

IMU 

24  Volts 

400  Milliamps 

9.6  Milliwatts 

GPS 

12  Volts 

250  Milliamps 

3.0  Milliwatts 

Telemetry  1 

24  Volts 

300  Milliamps 

7.2  Milliwatts 

Telemetry  2 

24  Volts 

300  Milliamps 

7.2  Milliwatts 

Total  Req. 

27  Milliwatts 

Battery 

>  200  mW-Hrs 

Table  III.  Power  Budget  of  Onboard  Components 
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C.  TRAJECTORY  CONTROL:  AN  APPLICATION 

The  intent  of  this  application  was  to  demonstrate  the  utility  of  the  RFTPS  by 
flight  testing  a  new  integrated  guidance  and  control  algorithm  that  was  shown  to  have 
good  performance  and  robustness  properties  both  theoretically  and  in  simulation  (see 
II).  This  project  was  chosen  because,  on  one  hand,  it  is  a  totally  unique  application 
in  terms  of  the  guidance  and  control  algorithms  implemented.  On  the  other  hand, 
to  implement  this  algorithm,  most  of  the  steps  required  of  any  application  involving 
autonomous  flight  of  an  air  vehicle  must  be  accomplished.  If  done  correctly,  the 
foundation  will  be  laid  for  follow  on  projects  and  joint  ventures  utilizing  unmanned 
air  vehicles. 

Generic  tasks  fundamental  to  guidance,  navigation  and  control  algorithm  de¬ 
velopment  were  accomplished  first.  To  begin  with,  a  high  fidelity  model  of  the  test 
bed  vehicle,  nicknamed  Frog ,  was  developed.  This  involved  a  complete  lateral  and 
longitudinal  parameter  identification  of  Frog’s  stability  and  control  derivatives.  This 
lead  to  the  development  of  a  six  degree  of  freedom,  nonlinear  simulation.  In  order 
to  manage  the  risk  associated  with  the  autonomous  flight,  it  was  decided  to  add  an 
onboard  inner-loop  controller.  The  inner-loop  controller  modifies  the  vehicle  dynam¬ 
ics  such  that  displacements  of  the  primary  longitudinal  and  lateral  control  effectors 
correspond  to  various  trimming  trajectories,  as  defined  in  Chapter  III.,  The  inner-loop 
controller  selected  was  a  commercial  autopilot  whose  control  laws  had  to  be  identified 
as  well.  Additionally,  accurate  and  timely  calibration  of  the  I/O  needed  to  become 
an  integral  part  of  the  RFTPS  to  account  for  changing  environmental  conditions, 
battery  levels,  etc. 

This  section  begins  with  a  brief  background  of  the  parameter  estimation  algo¬ 
rithm  used  to  identify  a  model  of  Frog.  Next,  the  experimental  testing  completed  to 
obtain  data  used  in  the  parameter  identification  process  is  summarized.  Flight  test 
data  is  compared  with  the  simulation  results  to  demonstrate  the  efficacy  of  the  ef¬ 
fort.  Then,  a  linear  controller  design  based  on  modeling  results  obtained  is  discussed. 
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Next,  a  nonlinear  controller  implemention  based  on  the  theory  developed  in  Chapter 
III  is  presented.  Finally,  flight  tests  conducted  using  the  RFTPS  to  track  an  inter¬ 
esting  representative  trajectory  are  discussed.  Data  from  flight  tests  are  presented 
and  contrasted  with  results  from  simulations.  Along  the  way,  implementation  issues 
germane  to  the  flight  testing  process  are  explained. 

1.  Theoretical  Background  for  Model  Identification 

Parameter  identification  of  the  test  bed  vehicle  and  inner- loop  autopilot  was 
accomplished  based  on  a  series  of  test  flights  and  lab  experiments.  The  Maximum 
Likelihood  Method  was  chosen  to  identify  the  parameters  of  the  model.  The  back¬ 
ground  is  extracted  primarily  from  [Ref.  18].  Assume  that  the  model  to  be  identified 
has  the  following  form 

x  =  A(p)x  +  B(p)u, 
y  =  C(p)x  +  D(p)u, 
x  =  state  vector, 
u  =  input  vector, 
y  =  otput  vector, 
p  =  parameter  vector. 

The  problem  at  hand  is  to  estimate  the  parameter  vector,  p,  given  a  data  set  of 
measured  inputs,  u,  and  outputs,  y.  To  that  end,  denote  the  estimated  output  based 
on  the  parameter  vector  p  as  y(p),  and  use  it  to  define  a  cost  function 

J(p )  =  \\y{p)-y\\l- 

The  method  seeks  to  minimize  the  cost,  J,  by  varying  the  parameter  vector  p.  Given 

an  initial  guess  of  the  parameter  vector  p0,  the  Jacobean  of  the  cost  function  J  is 

calculated  by  numerically  perturbing  the  parameter  vector  p0 

dJ_  _  y(p0  +  Sp)  -  y(Po) 
dp  8p  ’ 

=:  H0. 
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Then,  a  linear  approximation  for  y(p  +  Sp)  is 

y(p  +  8p)  =  y(p0) -\- H0Sp. 

The  cost  J  can  now  be  expressed  as  a  function  of  the  perturbation  of  the  parameter 
vector  as 


J(8p)  =  \\y(p  +  Sp)  -y\\l,  (IV.l) 

=  \\y(Po)  +  H08p  -  y\\l, 

=  ||y(po)  -  y\\l  +  2y(po)T H08p  -  2SpTHjy  +  SpT  H0Sp. 


In  order  to  determine  a  Sp  which  minimizes  equation  IV.l,  set 


dJ 

d(6p) 


2Hjy(Po)  -  2 Hjy  +  2 H* H08p, 

0, 


from  which  it  is  evident  that 


H^HoSp  =  Hq  (y  —  y(po))  (IV.2) 

must  hold. 

A  common  problem  encountered  in  solving  a  parameter  identification  problem 
is  the  presence  of  redundant  parameters  in  the  model.  This  results  in  the  matrix 
Hq  H0  being  singular,  and  presents  a  problem  if  a  solution  to  equation  IV.2  is  sought 
in  terms  of  Sp.  In  order  to  avoid  this  singularity,  the  following  problem  is  solved 
instead, 

(Hq  H0  +  pI)Sp  =  Hq  (y  —  y(po))-  (IV.3) 

With  the  descent  direction  Sp  known,  a  line  search  is  used  to  calculate  the  step  size. 
This  method  is  guaranteed  to  converge  to  a  minimum  for  the  cost  function  J,  although 
not  necessarily  a  global  minimum  [Ref.  18]. 

The  appealing  feature  of  this  method  for  the  problem  at  hand  is  that  it  can 
exploit  a  great  deal  information  known  about  the  model.  For  instance,  the  order  of  the 
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plant  and  most  of  the  structure  in  the  system  matrix  is  known,  as  is  a  reasonable  range 
of  values  for  the  parameter  vector  p  based  on  empirical  methods  (USAF  DATCOM). 

2.  Vehicle  Model  Identification 

The  conventional  configuration  of  Frog  suggested  that  the  parameter  identifi¬ 
cation  problem  could  be  decoupled  into  longitudinal  and  lateral  dynamics.  Maximum 
likelihood  parameter  identification  was  used  to  refine  existing  analytic  estimates  of 
the  longitudinal  stability  and  control  derivatives  [Ref.  34].  The  results  for  a  few  key 
longitudinal  stability  derivatives  are  compared  to  analytic  estimates  in  Table  IV.  The 
primary  difference  was  in  the  estimate  of  the  elevator  effectiveness,  which  was  less 
than  half  as  effective  has  previously  thought. 


Derivative 

Analytic 

Experimental 

%A 

cLa 

4.30 

4.09 

5.13 

cMa 

-.417 

-.557 

-25.1 

Cls, . 

-1.12 

r  -,39i 

186 

Cm6s 

-1.62 

-1.05 

54.3 

Table  IV .  Comparison  of  selected  longitudinal  derivatives. 


Figure  41  shows  the  response,  in  simulation,  of  a  longitudinal  model  of  Frog 
using  these  derivatives  to  an  elevator  doublet.  Comparisons  are  made  to  the  results 
from  flight  test. 

Next,  the  process  was  repeated  for  the  lateral  axis.  Aileron  and  rudder  dou¬ 
blets  were  executed  while  aileron  and  rudder  position,  roll  and  yaw  rates,  and  side-slip 
angle  were  measured.  Results,  for  a  few  key  lateral  stability  derivatives,  are  compared 
to  analytic  estimates  in  Table  V.  The  biggest  difference  was  the  value  of  CN/3,  which 
increased  by  over  300  percent.  This  doubled  the  estimate  of  the  natural  frequency  of 
the  dutch  roll  mode.  Figure  42  shows  the  response,  in  simulation,  of  a  lateral  model 
of  Frog  using  these  derivatives  to  an  aileron  doublet.  Comparison  to  the  results  from 
flight  test  are  also  shown. 


Ill 


Figure  41.  An  elevator  doublet  is  used  to  excite  the  longitudinal  dynamics  of  Frog. 
Test  flight  data  is  compared  with  simulation  results  to  assess  validity  of  the  model. 

3.  Autopilot  Model  Identification 

The  inner-loop  autopilot  is  a  “black  box”  containing  both  sensors  and  con¬ 
troller  logic.  The  intent  was  to  model  the  unit  as  closely  as  possible  without  disas¬ 
sembling  it.  The  published  function  of  the  autopilot  is  to  control  vertical  speed  and 
turn  rate  of  the  aircraft.  This  naturally  decouples  into  an  identification  problem  for 
the  lateral  channel,  and  an  identification  problem  for  the  longitudinal  channel. 

The  lateral  channel  employs  a  rate  gyro  to  track  turn  rate  commands  via 
feedback  to  the  aileron.  The  general  structure  is  shown  in  Figure  43.  In  order  to 
identify  the  dynamics  of  the  block  labeled  Tx  in  Figure  43,  the  unit  was  rotated  at 
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Table  V.  Comparison  of  selected  lateral  derivatives. 


differing  yaw  rates.  This  provided  a  variable  input  signal  to  the  feedback  path  with  a 
frequency  content  covering  0  to  20  radians  per  second.  The  commanded  yaw  rate,  rc, 
was  held  constant.  The  feedback  loop  was  broken  at  the  summing  junction  of  rc  and 
t'j b  i  and  the  feedback  signal  was  captured.  Parameter  identification  algorithms  were 
used  to  determine  that  the  feedback  loop  could  be  approximated  by  the  following 
transfer  function: 


—  .Is  +  1 
S  +  1 


(IV.4) 


With  the  autopilot  on,  a  step  command  in  turn  rate  was  transmitted  to  the 
vehicle  in  flight.  Vehicle  turn  rate,  as  measured  by  the  IMU,  was  recorded  and  used 
to  estimate  the  value  of  Kiat  at  0.25.  Test  data  from  that  flight  is  shown  in  Figure  44 
and  compared  with  simulation  results  using  the  autopilot  model. 

The  longitudinal  channel  of  the  autopilot  senses  the  rate  of  change  of  static 
pressure  in  order  to  control  the  vehicle’s  vertical  velocity  via  feedback  to  the  elevator. 
Flight  tests  data  capturing  the  response  of  the  vehicle  to  a  step  input  in  climb  rate 
command  was  used  for  model  identification.  The  identified  model  of  the  longitudinal 
channel  of  the  autopilot  is  shown  in  Figure  45. 

With  accurate  models  of  Frog  and  of  the  onboard  autopilot  identified,  it  was 
a  simple  matter  to  determine  the  command  bandwidths  of  the  inner-loop  controller 
(see  Figure  46).  For  this  project,  this  would  be  the  limiting  factor  in  achievable 
performance  of  the  guidance  algorithm.  Hardware-in-the-loop  testing  of  the  actua¬ 
tors  found  their  bandwidth  to  be  an  order  of  magnitude  higher  than  the  inner-loop 
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time  (seconds) 


Figure  42.  An  aileron  doublet  is  used  to  excite  the  lateral  dynamics  of  Frog.  Test 
flight  data  is  compared  with  simulation  results  to  asses  validity  of  the  model. 

command  bandwidths.  A  natural  next  step  would  be  to  remove  the  autopilot  after 
sufficient  time  and  experience  have  reduced  the  risk  exposure  to  acceptable  levels, 
and  exploit  the  extra  actuator  bandwidth  available. 

4.  Design  of  the  Controller 

The  design  requirements  to  be  met  were  as  follows: 

1.  Tracking  Requirements 

•  The  controller  should  achieve  perfect  steady  state  tracking  of  trajectories 
in  E  in  the  presence  of  a  constant  disturbance.  For  a  definition  of  the  set 
E ,  see  Chapter  III. 
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Figure  43.  Block  diagram  of  the  lateral  channel  of  the  inner-loop  autopilot. 


2.  Bandwidth  Requirements 

•  Command  bandwidths  along  the  lateral  and  longitudinal  channel  should  be 
maximized  to  ensure  tight  tracking  of  the  trajectory.  Adequate  frequency 
separation  between  the  inner  and  outer  loops  should  be  assured. 

3.  Closed  Loop  Damping  and  Stability  Margins 


Figure  44.  Flight  test  data  is  used  to  identify  the  dynamics  of  the  autopilot.  A  step 
signal  is  sent  to  the  lateral  channel  of  the  autopilot.  Measured  yaw  rate  is  compared 
to  simulation  results. 
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Figure  45.  Block  diagram  of  the  longitudinal  channel  of  the  inner-loop  autopilot. 


•  The  dominant  closed-loop  eigenvalues  should  have  a  damping  ration  of  at 
least  0.5.  Phase  and  gain  margins  should  be  no  less  than  45  degrees  and  6 
dB  respectively  in  each  control  loop. 

4.  Implementation  Requirements 

•  Control  of  Frog  from  the  console,  open-loop,  must  be  possible  in  order  to 
maneuver  the  vehicle  to  a  suitable  location  overhead  the  field  based  on 
visual  cues  and  displayed  navigational  data. 


Fraqu«ncy  [rad/sec] 


Figure  46.  Bode  plot  of  the  yaw  rate  command  to  yaw  rate  and  climb  rate  command 
to  climb  rate  for  Frog  with  the  autopilot  on. 
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•  Switching  from  open-loop  control  to  autonomous  flight  should  be  accom¬ 
plished  from  the  console  at  the  discretion  of  the  console  operator.  The 
switch  should  be  bumpless  with  no  undesirable  transients. 

•  The  definition  of  the  inertial  trajectory  passed  to  the  controller  should  be 
easily  defined  from  the  console,  and  expressed  in  terms  of  the  parameters 
introduced  in  Chapter  III,  namely,  helix  angle  (7C),  radius  (fec),  and  turn 
rate  (0C). 


a. 


Linear  Controller  Synthesis 
The  synthesis  of  the  controller  was  an  application  of  the  theory  outlined 
in  Chapter  III  where  the  trimming  trajectories  were  parameterized  by  the  vector 


Vc  = 


[uc  V’c  7c J  £  P?-  This  was  useful  for  the  derivation  of  the  generalized  error 
dynamics.  For  the  application  at  hand,  however,  it  was  convenient  to  remove  the 
explicit  dependence  on  vc.  Since  along  Pc  £  £ 

Vc  COs(7e) 

0c  ’ 


bc  = 


€  P?  to  parameterize  Pc  €  £  vice  rjc 


there  is  no  problem  in  using  tjc  =  [&c  tpc  7cj 
This  was  done  strictly  for  convenience,  since  during  the  flight  test,  the  throttle  was 
to  be  left  at  a  cruise  power  setting,  and  the  airspeed  was  not  explicitly  controlled. 
Flight  tests  tracked  a  single  trajectory  in  £  identified  as 

Vc  =  [  1146  5  0  1  ,  (IV.5) 


where  the  units  are  feet,  degrees  and  seconds,  respectively.  Based  on  (III.6),  (III.7) 
and  the  model  identification  results  in  section  2  and  3,  the  nonlinear  plant, 


'  Av  =Tv(v,n,A)  +  iv(v,n)H(v,n,u), 

=^h(V,n,A)  + 

iP  =j 'bRV ; 


(IV.6) 


l  i  A  =  Q  0, 

was  available  for  controller  synthesis.  Given  (IV.5)  and  (IV.6),  the  trimming  values, 
Vc,  Lie,  and  Uc  were  solved  as  the  solution  to 


Tv(Vc,nc,Ac)  +  MVc,£lc)n(Vc,Clc,Uc)  =0, 
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Fn{Vc,ttc,hc)  +  MVc,nc)H(Vc,Qc,Uc)  =  0, 

Q_1flc  -  A c  =  0, 


11^11 


cos(7c) 

bc^c 


0 


Q  •  -1  cos  (7c)  n 
Pc  -  sm  — -y-~  =  0, 

7<  -  [0  1  0]  arg("'K'BR)  =  0, 


(IV.7) 


where  the  arg  function  extracts  the  angles  X  from  the  rotation  matrix  7l(X):  X  = 
arg{H(X)).  Numerically  solving  (IV.7),  the  trim  values  were  found  to  be 


vS 


nTc  = 


a  Tc 


87.7  2.037  2.43 


0.00176  0.029  0.087 


13.41  0.023  0 


1  T 


where,  as  before,  standard  units  are  feet,  degrees  and  seconds. 

Based  on  lab  and  flight  testing  of  the  onboard  sensors,  the  decision  was 
made  to  design  an  output  feedback  controller  of  the  form  (see  Figure  IV. 8): 


6E  =  [ij,  fof  -  [Syc  6zc]T, 
isx*  =  AclSXcl  +  BC28XC2  +  B&8E, 
£6Xc2  =  6E, 


6U  —  Cc\8Xc\  T>C2SXC2  +  T>cz8E^ 


(IV.8) 


where  8U  —\rc  hc  . 

Classical  control  techniques  were  employed  to  design  the  controller,  Ci, 
shown  in  Figure  47.  Performance  objectives  included  setting  the  loop  gain  crossover 
frequencies  at  0.5  radians  per  second  along  each  channel  based  on  the  inner-loop 
command  bandwidths  (see  Figure  46).  Root-locus  analysis  along  the  lateral  channel 
provides  the  most  intuitive  view  of  the  control  problem  (see  Figure  48).  The  open- 
loop  plant  has  unstable  zeros  along  the  lateral  channel  due  to  the  dihedral  effect  of 
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the  high  wing  design.  These  unstable  zeros  will  naturally  attract  the  free  integrators 
in  the  synthesis  model  if  left  unattended. 


Figure  48.  Root-locus  for  the  lateral  channel. 


The  straightforward  solution  was  to  interlace  the  pole-zero  structure 
of  the  synthesis  model  with  a  stable  pair  of  complex  zeros  sufficiently  close  to  the 
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free  integrators.  The  robustness  limit  was  set  by  the  dutch  roll  poles  which  were 
forced  to  eventually  migrate  to  the  non-minimum  phase  zeros.  Modification  of  the 
dutch  roll  behavior  would  require  a  different  approach  than  that  chosen  with  the 
inclusion  of  the  inner- loop  autopilot.  Replacement  of  the  inner-loop  autopilot  is  a 
natural  extension  for  future  flight  test  work.  Design  concerns  and  solutions  along 
the  longitudinal  channel  were  qualitatively  similar.  The  resulting  design  was  a  sixth 
order  controller. 

Nyquist  diagrams  of  the  loop  transfer  function  for  the  lateral  and  lon¬ 
gitudinal  channels  are  shown  in  Figure  49  and  50.  There  it  can  be  seen  that  phase 
and  gain  margin  design  requirements  along  each  channel  have  been  met. 


Real 


Figure  49.  Nyquist  diagram  of  the  loop  transfer  function  for  the  lateral  channel.  The 
phase  margin  is  112  degrees  and  the  gain  margin  is  6  dB. 

5.  Nonlinear  Implementation 

The  controller  designed  in  the  preceding  section  was  implemented  on  the  non¬ 
linear  plant  using  the  implementation  proposed  in  Chapter  III  and  is  given  next  (see 
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Figure  50.  Nyquist  diagram  of  the  loop  transfer  function  for  the  longitudinal  channel. 
The  phase  margin  is  145  degrees  and  the  gain  margin  is  infinite. 


Figure  51): 


tnp  -  Po(so)), 

[y-yc  z-zc |, 

AclXcl  +  Bc2E  +  Bc3ftE , 
Cc  iXcl  +  Vc2E  +  Vc3£tE, 
Xc2. 


(IV.9) 


Figure  51.  Nonlinear  Implementation  of  the  Controller 
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The  following  algorithm  was  implemented  in  the  block  labeled,  Calc  Me,  in 
Figure  51  in  order  to  compute  Me-  Assume  the  position  of  the  vehicle  is  [xi,  yi  zi]T, 
and  let  the  center  of  the  trajectory  be  specified  as  [: xc ,  yc  zc]T .  Then,  the  projection 
of  the  position  of  the  vehicle  onto  the  trajectory,  as  defined  by  fjc,  is 

r  ^ 


Pc{s0 ) 


x0  3/o  zo  \  > 


where 


Xq  = 


s0cos(7c) 

bc  cos( - - - )  +  xc, 


.  S0COS(7C) 

?/o  =  oc  sm( - r - )  +  y, 

oc 

Zo  =  ^cMotan(7c)  +  zc. 


(IV.10) 


When  7C  is  zero,  the  parameter,  s0,  can  be  computed  by  considering  the  projection 
of  P  onto  a  co-level  circle  with  radius,  bc,  and  center  [ic,  yc  z{\T .  Then, 


s0  =  6ctan-1(— — V—).  (IV.ll) 

xi-  xc 

The  position  error  resolved  in  the  Frenet  frame  attached  at  the  point  Pc(s o) 
is 


Xe>pT 

-cos(7c)sin(f^)  cos(7c)cos(f^-)  -  sin(7c) 

1 - 

O 

1 

H 

i _ 

Verr 

— 

-cos(f^)  -sin(f^)  0 

1 

H 

o 

Zerr 

sin(7c)  sin(f^)  -  sin(7c)  cos(f^)  cos(7c) 

i 

i 

£ 

i _ 

=:  Me.  (IV. 12) 

If  the  helix  angle  is  not  zero,  then  a  simple  solution  is  not  available.  The  point 
can  be  found,  however,  by  noting  that  ME  must  be  of  the  form  [0  yerr  zerr]T .  Then 
using  (IV. 12), 

-cos(7c)sin(^)(a;, -a:0)  +  cos(7c)cos(^)(2//-y0)-sin(7c)(2:/-2:o)  =  0, 

(IV. 13) 
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must  hold.  Using  (IV. 10),  (IV.  13)  is  rewritten  as 

-  cos(7c)  smA(xt  -  bc  cos(^^))  +  Xc)+ 
oc  bc 

(  \  /  ^0  \  /  j  .  /  <S()  COS  ('Tc)  \  \ 

(7c)  cos(— )(yi  -  bc  sm( - j—t — )  +  yc)~ 


COS 


sin(7c)(z/  -  ipcbcSo  tan(7c)  +  zc)  =  0, 


(IV. 14) 


which  can  be  solved  for  s0. 


D.  CONTROLLER  IMPLEMENTATION  FOR  FLIGHT 
TEST 

During  a  flight  test  it  is  critical  that  the  transition  from  manual  to  autonomous 
flight  occur  without  any  undesirable  transients.  The  method  chosen  to  achieve  this 
was  to  initiate  autonomous  flight  with  the  vehicle  on  the  trajectory,  and  with  the 
controller  states  recruited  to  their  nominal  values.  An  elegant  approach  toward  partial 
completion  of  this  task  was  to  restructure  the  controller  using  the  ^-Implementation. 
One  important  convenience  of  this  structure  is  the  straightforward  manner  in  which 
the  controller  states  can  be  recruited  at  the  initiation  of  autonomous  flight  based  on 
the  trajectory  definition  parameter  fjc.  Let  ton  be  the  time  that  the  console  operator 
turns  the  controller  on.  Then,  setting 


-Vc2(ton  ) 


Xd  {ton) 


4>c  COS  (7c) 

ipch  tan(7c) 

0 

0 

0 

0 


(IV. 15) 


perfectly  recruits  the  controller  states  at  the  initiation  of  autonomous  flight.  The 
structure  in  (IV.9)  is  also  convenient  for  implementing  hard  limits  on  the  feedback 
signal.  It  was  experimentally  determined  that  the  command  signals  to  the  autopilot 
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should  be  kept  within  the  following  ranges 

—  15  degrees  per  second  <bc  <  +15  degrees  per  second, 

—2000  feet  per  minute  <  hc  <  +2000  feet  per  minute.  (IV. 16) 

Since  the  feedback  signals  are  the  outputs  of  integrators  in  (IV. 9),  the  states  X&  were 
easily  hard  limited  to  the  values  in  (IV. 16),  with  anti-windup  implemented  on  the 
associated  integrators. 

To  affect  a  smooth  transition,  all  that  remained  was  to  initiate  autonomous 
flight  when  the  vehicle  was  on  the  reference  trajectory  and  aligned  with  it.  Since  there 
were  no  mission  requirements  regarding  the  center  of  the  trajectory,  the  coordinates 
were  computed  to  place  the  vehicle  on  the  trajectory  at  initiation  of  autonomous 
flight.  Furthermore,  the  orientation  of  the  Frenet  frame  was  matched  to  the  vehicle’s 
heading.  Let  i (>on  be  the  vehicle  heading  at  ton.  Let  the  trajectory  parameter  be 
specified  by  (IV. 5).  Then,  setting 

_  cos(V>/)  cos(7c) 

Xc  —  Xon  , 

be 

sin (ipi)  cos(7 c) 

Vc  =  Von - r - 

be 

%c  ~  Zon 

defines  a  trajectory  where  Me  at  ton,  as  defined  by  (IV.12),  is  zero,  and  A3  =  Ac3, 
where  the  subscript  indicates  the  third  element  of  the  vector. 

1.  Additional  Implementation  Issues 

Prior  to  autonomous  flight  of  Frog ,  it  was  decided  to  test  the  RFTPS  by  flying 
Frog  remotely  from  the  workstation  console.  The  console  operator  was  provided  with 
the  appropriate  displays  showing  Frog’s  position,  heading,  and  velocity,  and  used  that 
information  to  command  the  vehicle’s  turn  rate  and  climb/descent  rate  in  order  to 
keep  Frog  in  the  local  operating  area. 

The  vehicle’s  position,  as  reported  by  the  onboard  GPS,  is  in  units  of  latitude, 
longitude  and  height  above  mean  sea  level.  In  order  to  provide  a  more  intuitive 
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navigational  reference  frame,  the  location  of  the  workstation  at  the  field  where  the 
flight  tests  were  conducted  was  surveyed.  This  postion  was  used  to  define  the  origin 
of  a  local  tangent  plane.  Let  [Ai,  A2,  h]T  be  the  vehicle’s  position,  as  reported  by  the 
GPS  receiver,  where 


Ai  =  degrees  of  latitude, 

A2  =  degrees  of  longitude, 

h  =  height  GPS  in  meters.  (IV. 17) 


The  variable  h  is  a  height  referenced  to  the  surface  of  an  ellipsoid  approxi¬ 
mating  the  shape  of  the  earth.  Two  important  parameters  describing  this  reference 
ellipsoid,  termed  WGS%A,  are  its  eccentricity  factor  (e)  and  the  length  of  its  semi¬ 
major  axis  (a).  The  distance  from  the  origin  of  the  W GSM  ellipsoid  to  a  point  on 
its  surface  where  the  local  latitude  is  Aj  is  given  by 


N  = 


a 


\f\  —  e2sin2(Ai) 


(IV. 18) 


Consider  a  Cartesian  coordinate  system  with  its  origin  at  the  center  of  the 
WGS84  ellipsoid,  oriented  such  that  its  z-axis  is  aligned  due  north,  its  x-axis  intersects 
the  prime  meridian,  and  its  y-axis  completes  the  right  hand  rule.  This  reference 
coordinate  system  is  termed  Earth  Centered  Earth  Fixed  (ECEF).  Then,  given  the 
position  reported  by  GPS  (IV. 17),  the  position  expressed  in  the  ECEF  reference  frame 
is 


x  =  (N  +  h)  cos(A2)  cos(Ai). 
y  =  (N  +  h)  cos(A2)  sin(Ai). 

*  =  (iV(l  —  e2)  +  h)  sin(A2). 

Let  [Ai0  A2o  h]T  be  the  surveyed  position  of  the  workstation,  and  let  [®0,  t/o,  z0]T  be 
the  same  location  expressed  in  ECEF  coordinates,  and  suppose  this  position  is  used 
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to  define  the  origin  of  a  local  tangent  plane  reference  frame.  Sign  convention  and 
orientation  of  the  local  tangent  plane  reference  frame  are  defined  as  positive  x-axis 
values  extending  due  north,  positive  y-axis  values  extending  due  east,  and  positive 
z-axis  values  extending  straight  down.  Furthermore,  assume  [xjrog  yfTOg  Zfrog]T  is  the 
reported  position  of  the  vehicle  expressed  in  the  ECEF  coordinate  system.  Then, 


Xl 

-sin(A2o)cos(Ai0)  -  sin(A2fl)  sin(Alo)  cos(A2o) 

{Xfrog  ~  Xo) 

yi 

— 

-sin(Alo)  cos(Al0)  0 

( Vjrog  ~~  Vo) 

Zi 

-cos(A2o)cos(Ai0)  —  cos(A2o)  sin(Ai0)  -sin(A2o) 

( zfrog  ^o) 

(IV.19) 


is  the  position  of  the  vehicle  in  the  local  tangent  plane  reference  frame.  This  position 
was  displayed  on  the  console,  and  later,  the  trajectories  tracked  by  Frog  were  defined 
in  this  reference  frame. 

The  final  issue  that  needed  to  be  resolved  was  the  accurate  and  timely  calibra¬ 
tion  of  the  command  signals  from  the  console  to  the  vehicle.  The  autopilot  onboard 
the  vehicle  expected  to  see  commands  in  terms  of  PWM  signals.  The  pulse  width 
modulated  signals  were  generated  by  first  converting  the  command  signals  to  analog 
voltages  via  the  Digital-to- Analog  converter.  Then  the  analog  voltages  were  directed 
to  a  Futaba  transmitter,  specially  modified  to  respond  to  analog  voltages  instead  of 
the  movement  of  the  exterior  joysticks.  Next,  a  receive  module  onboard  Frog  con¬ 
verted  the  transmitted  signals  to  PWM  format,  where  they  were  sent  to  the  autopilot. 
A  functional  block  diagram  of  the  architecture  used  to  calibrate  the  uplink  is  shown 
in  Figure  52. 

The  key  to  calibrating  the  uplink  was  the  determination  of  the  functions  F~}m 
(Block  1)  and  GVgtt  (Block  2)  in  Figure  52.  This  was  done  in  two  steps.  The  first 
step  involved  sending  constant  commands  to  the  DAC  from  the  user  interface  (Block 
10,  11  and  12).  This  resulted  in  flight  patterns  consisting  of  numerous  constant 
rate  turns  to  the  left  and  to  the  right,  and  to  constant  rate  climbs  and  descents. 
A  receive  module,  which  was  a  duplicate  of  the  one  onboard  Frog ,  converted  the 


126 


Figure  52.  Calibrating  the  Uplink 


transmitted  signal  to  PWM  format.  This  was  then  converted  and  stored  in  digital 
format  by  the  RFTPS  via  the  pulse  width  modulated  signal  converter  I/O  module 
(Block  3,  4  and  5).  Concurrently,  the  onboard  navigation  sensors  transmitted  yaw 
rate  and  climb  rate  data,  among  other  things,  to  the  RFTPS  (Block  6,  7,  8  and  9). 
Post  processing  of  the  data  revealed  linear  relationships  between  the  PWM  signals 
sent  to  the  autopilot  and  the  respective  climb/descent  or  turn  rate  of  the  vehicle 
(see  Figure  53).  The  relationships  between  the  command  signals  in  terms  of  their 
PWM  values  ( rCpwm  and  hCpwm )  and  the  steady-state  performance  of  Frog  in  flight  are 
expressed  as 


0.0885rCjm;m  -  151.476, 

(IV.20) 

^Tpwm  Cpium  )  ? 

12.3929ACp_  -  18193, 

(IV.21) 

foptum  ^  Cpivm  )  7 

(IV.22) 
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where  r  is  the  vehicle’s  yaw  rate  in  degrees  per  second,  and  h  is  the  vehicle’s  climb/descent 
rate  in  feet  per  minute. 


PWM 


PWM 


Figure  53.  Top  graph:  measured  vehicle  yaw  rate  (degrees  per  second)  versus  PWM 
signal  (/x  seconds)  into  the  lateral  channel  of  the  inner-loop  autopilot.  Bottom  graph: 
measured  vehicle  climb  rate  (feet  per  minute)  versus  PWM  signal  (//seconds)  into  the 
longitudinal  channel  of  the  inner-loop  autopilot. 

The  second  step  in  calibrating  the  uplink  involved  the  modified  Futaba  trans¬ 
mitter  (Block  2).  The  known  voltages  applied  to  the  transmitter  were  recorded, 
while  the  duplicate  receive  module  was  used  to  decode  the  transmitted  signal,  and 
the  RFTPS  was  used  to  record  the  corresponding  PWM  value  (Block  3,  4  and  5). 
The  relationships  were  linear  and  expressed  as 

rCpwm  =  686.7^-234.1,  (IV.23) 

=-  Grvolt{rvolt)i 

hCpwm  =  800/^-470,  (IV.24) 
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~ :  GKo iS^volt), 

where  hvoit  is  voltage  sent  to  the  longitudinal  channel  of  the  modified  Futaba  trans¬ 
mitter,  and  rvoit  is  the  voltage  sent  to  the  lateral  channel. 

That  completed  the  calibration  of  the  uplink.  Given  a  commanded  climb / descent 
rate  ( hc )  in  feet  per  minute,  and  commanded  yaw  rate  (rc)  in  degrees  per  second  at 
the  console,  the  voltages  sent  to  the  modified  transmitter  were  calculated  as 


hvoit 

^volt 


GhvoltFhpwJXc' 
g:\f~1 


rvolt  Tpwm  c* 


E.  RESULTS  AND  ANALYSIS 


(IV.25) 

(IV.26) 


This  section  summarizes  the  results  of  two  flight  tests  of  the  guidance  and 
control  algorithm  developed  in  the  preceding  section.  While  the  trajectory  definition 
parameter  was  identical  for  both  tests,  the  test  flights  took  place  on  different  days 
with  very  different  environmental  conditions.  Furthermore,  on  the  first  test,  only  the 
lateral  channel  of  the  guidance  algorithm  was  active.  Longitudinal  control  was  done 
open-loop  by  the  console  operator.  Both  flights  took  place  at  approximately  500  feet 
of  altitude  above  ground  level.  Wind  measurements  were  made  at  ground  level  on 
the  runway,  and  later  incorporated  into  the  simulation.  The  pilot  maintained  control 
of  the  throttle  throughout  the  tests.  During  autonomous  flight,  the  pilot  left  the 
throttle  at  the  trim  setting  for  the  trajectory  defined.  The  rudder  was  not  used. 

At  the  time  of  the  tests,  the  RFTPS  had  been  in  operation  for  approximately 
three  months.  The  two  flight  tests  presented  were  not  the  first  time  the  RFTPS 
was  used  to  control  Frog.  Some  of  the  model  identification  process,  and  most  of 
the  calibration  process,  used  the  RFTPS  to  control  Frog.  This  was  primarily  due 
to  the  fact  that  the  pilot  used  a  conventional  stick  configuration  to  control  Frog. 
Longitudinal  signals  corresponded  to  fore  and  aft  motion,  and  lateral  commands 
corresponding  to  left  and  right  motion.  Movement  along  one  axis  invariably  corrupted 
the  signal  along  the  other  axis.  In  contrast,  control  signals  generated  by  the  RFTPS 
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were  very  precise  and  perfectly  decoupled.  Also,  tests  had  been  successfully  completed 
whereby  a  portable  computer  was  used  to  send  commands  to  the  RFTPS  and  control 
Frog.  The  flight  tests  presented  do  represent  the  first  time  that  a  guidance  and  control 
algorithm  was  used  to  control  Frog  fully  autonomously. 

1.  First  Flight  Test 

The  first  test  of  the  guidance  algorithm  occurred  on  June  20,  1997.  The 
wind  was  measured  at  10  mph  out  of  the  northwest  with  gusts  to  15  mph.  The 
pilot  launched  Frog  and  brought  it  up  to  a  safe  altitude.  Control  was  passed  to  the 
console  operator  who  turned  the  controller  on.  The  trajectory  definition  is  repeated 
for  convenience, 


7c  =  0  degrees, 

ipc  =  5  degrees  per  second, 

bc  =  1146  feet. 

Autonomous  control  of  the  longitudinal  channel  was  not  implemented.  The  GPS 
operated  in  the  differential  position  mode  throughout  the  test.  Prior  testing  of  this 
GPS  revealed  that  position  error  in  the  horizontal  plane,  using  GPS  in  differential 
mode,  had  a  standard  deviation  of  10  feet.  The  positions  shown  are  those  reported 
by  GPS.  The  true  position  is  unknown  but  thought  to  be  within  about  10  feet  of  that 
shown.  Later,  the  process  was  repeated  in  simulation  using  the  measured  value  of 
the  wind.  The  trajectory  flown  by  the  vehicle  is  shown  projected  onto  the  horizontal 
plane  in  Figure  54.  Additionally,  the  reference  trajectory  and  the  trajectory  obtained 
in  simulation  is  shown. 

The  controller  activity  in  the  lateral  channel  is  shown  alongside  the  lateral 
error  signal  in  Figure  55.  According  to  the  orientation  of  the  Frenet  frame,  the  error 
signal  went  negative  when  the  vehicle  was  inside  of  the  reference  trajectory.  The 
controller  activity  has  noticeable  high  frequency  content  caused  by  the  interaction 
of  the  one  second  update  rate  of  the  GPS  and  the  slow  complex  zeros  placed  in 
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Figure  54.  The  first  (near)  autonomous  flight  of  Frog.  The  commanded  trajectory  is 
shown  as  a  solid  line  while  the  path  flown  is  shown  as  a  broken  line.  Also  shown  are  the 
results  from  nonlinear  simulation.  The  wind  was  18  feet  per  second  out  of  the  west, 
northwest.  The  graph  is  oriented  with  the  y-axis  pointing  due  north.  Approximately 
two  and  one  half  minutes  of  flight  are  shown. 

the  controller.  The  nominal  commanded  yaw  rate  should  be  5  degrees  per  second, 
but  instead  has  a  mean  value  of  8  degrees  per  second.  This  is  indicative  of  the 
integral  action  compensating  for  modeling  and  calibration  errors.  The  ground  speed 
(not  shown)  oscillated  by  twice  the  magnitude  of  the  measured  wind.  The  vehicle’s 
indicated  airspeed  was  nearly  constant.  Therefore,  the  wind  appeared  as  a  sinusoidal 
disturbance  at  a  frequency  of  0.796  radians  per  second.  As  the  loop  gain  cross  over 
frequency  was  0.5  radians  per  second  along  the  lateral  channel,  little  gain  was  available 
to  suppress  this  disturbance. 

Similar  qualitative  and  quantitative  performance  was  observed  in  simulation. 
The  slight  difference  in  orientation  of  the  two  trajectories  is  most  likely  due  to  mis¬ 
alignment  of  the  modeled  and  actual  wind.  Table  VI  quantitatively  compares  flight 
test  data  to  linear  and  nonlinear  simulation  results.  The  close  agreement  in  average 
(RMS)  tracking  error  indicates  that  the  design  has  good  robustness  properties.  The 
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Figure  55.  Top  graph:  Commanded  vehicle  yaw  rate  in  degrees  per  second  from  the 
controller  along  the  trajectory,  flown  on  June  20,  1997.  Bottom  graph:  Lateral  error 
in  feet,  as  computed  by  the  guidance  algorithm,  along  the  same  trajectory. 


relatively  large  tracking  errors  are  indicative  of  the  low  loop  gain  available  for  dis¬ 
turbance  rejection  of  wind  effects.  In  retrospect,  performance  requirements  should 
be  formulated  to  ensure  adequate  gain  at  these  frequencies.  The  frequency  of  this 
disturbance,  loj. ,  is  well  known  at  the  design  stage.  It  can  be  defined  using  fjc  as 


LOd  = 


360 

ipc  cos(7 c) 


(IV. 27) 


With  estimates  of  the  maximum  magnitude  of  the  wind,  and  requirements  on  the 
maximum  permissible  tracking  errors  allowed,  a  performance  requirement  could  nat¬ 
urally  be  formulated  as  an  H0 0  constraint. 
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Linear  Simulation 

Nonlinear  Simulation 

Flight  Test 

Lateral  Mean  Error 

-21.92  feet 

-22.1  feet 

-18.35  feet 

Lateral  RMS  Error 

111.27  feet 

111.49  feet 

121.24  feet 

Lateral  Peak  Error 

140.57  feet 

140.01  feet 

219.54  feet 

Table  VI.  Error  Comparison  for  Flight  of  June  20,  1997:  Flight  Test  &  Simulation 


2.  Second  Flight  Test 

On  July  23,  1997,  a  second  flight  test  was  conducted.  The  second  flight  test 
provided  the  opportunity  to  test  the  guidance  algorithm  in  near  ideal  weather  condi¬ 
tions.  The  wind  was  1  to  2  miles  per  hour  out  of  the  west,  and  the  air  was  absent  of 
thermal  activity  and  disturbances.  This  time,  the  longitudinal  channel  was  operative. 

Frog  was  brought  up  to  altitude  by  the  pilot  and  control  handed  over  to  the 
console  operator.  The  console  operator  switched  to  autonomous  flight  with  the  tra¬ 
jectory  parameters  defined  as  on  June  20,  1997.  Once  again,  post  test  flight  data  is 
compared  with  simulation  results  incorporating  wind  levels  measured.  The  results 
are  summarized  in  Table  VII,  followed  by  data  from  the  flight. 


Linear  Simulation 

Nonlinear  Simulation 

Flight  Test 

Lateral  Mean  Error 

-2.419  feet 

-2.431  feet 

5.49feet 

Lateral  RMS  Error 

11.162feet 

11.1869  feet 

21.41  feet 

Lateral  Peak  Error 

15.24  feet 

15.21  feet 

41.5  feet 

Longitudinal  Mean  Error 

-.006  feet 

-.005  feet 

3.658  feet 

Longitudinal  RMS  Error 

.058  feet 

.091  feet 

14.949  feet 

Longitudinal  Peak  Error 

.089  feet 

.0584  feet 

37.1725  feet 

Table  VII.  Error  Comparison  for  Flight  of  July  23,  1997:  Flight  Test  k  Simulation 


The  resulting  path  in  space  flown  on  July  23  is  shown  in  Figure  57.  It  is 
compared  to  the  reference  trajectory.  The  projection  of  the  trajectory  tracked  onto 
the  horizontal  plane  is  shown  in  Figure  56.  It,  also,  is  compared  to  results  from 
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simulation.  The  history  of  the  controller  activity  is  shown  for  the  lateral  channel  in 
Figure  58,  and  for  the  longitudinal  channel  in  Figure  59. 


Figure  56.  The  second  autonomous  flight  of  Frog.  Weather  conditions  were  near 
ideal  as  Frog  tracked  the  3-D  trajectory  shown  by  the  dashed  line.  The  results  from 
simulation  are  shown  as  a  dash-dot  line. 


Figure  57.  The  second  autonomous  flight  of  Frog.  Weather  conditions  were  near  ideal 
as  Frog  tracked  the  3-D  trajectory  shown. 
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Figure  58.  Top  graph:  Commanded  vehicle  yaw  rate,  in  degrees  per  second  from  the 
controller,  along  the  trajectory  flown  on  July  23,  1997.  Bottom  graph:  Lateral  error 
in  feet,  as  computed  by  the  guidance  algorithm,  along  the  same  trajectory. 


With  little  wind,  the  test  data  characterizes  the  performance  of  the  guidance 
and  control  algorithm  in  the  presence  of  modeling  errors,  transport  lag,  hardware  non- 
linearities,  and  sensor  noise.  The  simulation  results  were  a  close  match  to  flight  test 
data  along  the  lateral  channel.  The  average  tracking  error  just  over  21  feet.  It  can  be 
seen  in  Figure  58  that  the  integral  control  is  holding  about  one  half  degree  per  second 
commanded  yaw  rate  to  compensate  for  constant  disturbances.  In  flight,  tracking 
errors  along  the  longitudinal  channel  were  even  less  than  lateral  tracking  errors.  The 
average  command  signal  along  the  longitudinal  channel  was  -5  feet  per  second.  This 
probably  indicates  that  the  power  setting  was  too  high.  Subsequent  testing  will 
incorporate  airspeed  and  throttle  control  which  will  address  this  issue.  In  simulation, 
however,  longitudinal  tracking  errors  were  extremely  small.  The  discrepancy  is  most 
likely  the  result  of  unmodeled  vertical  disturbances  in  the  airmass  due  to  light  thermal 
activity. 
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Figure  59.  The  output  of  the  longitudinal  channel  of  the  controller  is  shown  along 
with  the  error  signal  on  which  it  is  acting.  Note  that  the  positive  z-axis  points  down 
and  that  positive  error  corresponds  to  the  vehicle  being  below  the  reference  trajectory. 

F.  CONCLUSIONS 

In  this  chapter,  an  integrated  system  for  the  design,  development  and  testing  of 
guidance,  navigation,  and  control  algorithms  for  unmanned  air  vehicles  was  presented. 
Extensive  use  was  made  of  commercial  off-the-shelf  (COTS)  hardware.  This  kept  costs 
low,  and  made  the  system  easily  scaleable.  Sophisticated  autocode  tools  allowed  a 
two  man  team  to  write,  test,  and  maintain  thousands  of  lines  of  error  free  real  time 
code.  In  a  single,  unified  environment,  the  avionics  system  was  designed,  simulated, 
simulated  incorporating  hardware-in-the-loop  (HITL),  tested  in  flight,  and  used  to 
control  an  aircraft  in  flight. 

As  a  proof-of-concept  demonstration,  the  RFTPS  was  used  to  take  the  in¬ 
tegrated  guidance  and  control  concept  presented  in  Chapter  III  and  evaluate  it  in 
the  environment  for  which  it  was  proposed  to  be  used.  The  project  began  with  an 
unmanned  air  vehicle  with  unknown  flight  characteristics.  In  addition,  a  “black  box” 
autopilot  with  unknown  internal  dynamics  was  placed  onboard  the  vehicle.  Through 
the  use  of  the  RFTPS,  a  high  fidelity  simulation  of  the  vehicle  and  autopilot  was  built 
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and  used  to  synthesize  the  applicable  guidance  and  control  laws.  Extensive  testing 
in  simulation  followed,  and  appropriate  user  interfaces  were  developed.  Then,  the 
RFTPS  was  used  to  control  the  vehicle  in  flight  using  the  guidance  and  control  laws 
developed,  collect  the  data  during  the  flight  test,  post  process  the  data,  and  evaluate 
the  performance  of  the  algorithms. 

The  success  of  the  project  demonstrated  both  the  utility  of  the  integrated  guid¬ 
ance  and  control  algorithm  as  well  as  the  capabilities  of  the  RFTPS.  The  integrated 
guidance  and  control  algorithm  was  shown  to  work  well  in  a  real  world  application. 
Performance  in  flight  was  very  close  to  performance  in  simulation,  which  speaks  well 
of  the  robustness  properties  of  the  controller.  Changing  environmental  conditions 
highlighted  some  disturbance  rejection  issues  that  should  be  addressed  in  the  future. 
The  RFTPS  was  shown  to  be  powerful,  portable,  rugged,  effective  in  the  field  and  in 
the  lab,  and  safe  and  reliable  at  controlling  an  aircraft. 
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APPENDIX  A.  THE  TAIL  SIZING  DESIGN 

TOOL 


1.  INTRODUCTION 

This  appendix  details  the  operation  of  the  Tail  Sizing  Design  Tool  The  Tail 
Sizing  Design  Tool  runs  from  the  MATLAB  command  line,  and  requires  the  LMI  and 
CONTROL  Toolboxes.  The  purpose  of  the  Tail  Sizing  Design  Tool  is  to  allow  the 
user  to  map  and  view  the  Tail  Sizing  Design  Space  for  a  given  aircraft  definition,  or 
compare  the  Tail  Sizing  Design  Space  of  two  different  aircraft  definitions.  There  are 
three  versions  of  the  Tail  Sizing  Design  Tool.  The  Tail  Sizing  Design  Tool  Version 
A  maps  the  Tail  Sizing  Design  Space  for  the  high  angle-of-attack  excursion  search¬ 
ing  over  static,  state  feedback,  controllers.  Version  B  solves  the  same  problem  but 
searches  over  dynamic,  output  feedback,  controllers.  Version  C  maps  the  Tail  Sizing 
Design  Space  for  the  wind-shear  penetration  constraint  searching  over  static  state 
feedback  controllers.  Version  A  and  B  are  well  developed  and  allow  the  user  to  in¬ 
clude  aeroelastic  effects,  the  addition  of  a  canard,  and  to  view  the  Tail  Sizing  Design 
Space  in  a  three  dimensional  plot.  Version  C  is  less  well  developed  and  provides  for 
only  rigid  body,  tail  only,  aircraft  dynamics,  and  two  dimensional  views. 

The  general  structure  of  all  three  versions  is  similar.  The  Tail  Sizing  Design 
Tool  is  comprised  of  three  directories  which  must  reside  on  the  same  level  within 
the  user  s  file  system.  The  first  directory  is  termed  GUI ,  which  is  an  acaronym  for 
graphical  user  interface.  As  the  name  suggests,  it  contains  files  which  allow  the 
user  to  specify  an  aircraft  definition,  generate  a  database  for  an  aircraft  definition  or 
view  a  Tail  Sizing  Design  Space  for  an  aircraft  definition  by  pushing  the  appropriate 
“buttons”  on  the  display  generated.  The  second  directory  is  termed  MODEL,  and 
it  contains  the  files  necessary  to  model  the  dynamics  of  an  aircraft.  This  directory 
contains  the  user  supplied  aerodynamic  stability  and  control  derivatives.  The  third 
directory  is  termed  DATA ,  and  it  contains  data  files  generated  by  running  the  Tail 
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Sizing  Design  Tool. 

Assume  for  the  moment  that  the  proper  stability  and  control  derivatives  have 
been  placed  appropriately  in  the  MODEL  directory.  The  process  is  as  follows. 

1 .  From  the  GUI  directory,  run  size.it. 

2.  Fill  in  the  appropriate  values  for  the  range  of  tail  volumes  and  actuator  rates 
of  interest. 

3.  Specify  the  aircraft  definition  parameters  such  as  the  use  of  a  canard  or  inclu¬ 
sion  of  a  flexible  mode. 

4.  For  output  feedback  controllers,  specify  the  output  sensors  to  be  used  from 
the  available  choices. 

5.  Name  the  database  file  and  start  the  generation  of  the  data.  This  executes 
the  program  getdata. 

6.  Run  the  program  view. it  to  querry  a  database  previously  generated. 


2.  GENERATING  A  DATABASE 

First,  we  will  consider  the  two  programs  size.it  and  getdata.  The  interface 
generated  by  size.it  (Version  B)  is  shown  in  Figure  60.  By  selecting  the  push  button, 
’’Output  Page,”  another  GUI  is  created  (Figure  61).  This  provides  the  user  the  option 
of  specifying  which  sensors  to  use  for  feedback.  When  the  user  is  satisfied  with  the 
definition  of  the  aircraft,  he  begins  execution  by  selecting  the  pushbutton  Run  It!. 
This  executes  the  program  Getdata ,  shown  next  for  Version  B. 


mmmmmmmmmra 


•/. 


Getdata.m 


%  Initialize  global  variables  and  move  to  the  model  directory. 
cgrate=[];  data=[]; 
cd  . . 
cd  model 

*/,Use  the  graphics  handles  to  transfer  the  user  defined  aircraft 
'/#def intions  to  variables  in  the  workspace.  Begin  with  the  frequency 
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Figure  60.  Interface  called  by  sizeit.m 

'/.  of  the  flexible  mode. 

freql  =  st r2num (get (freq_ed,  'string')) 

save  flexdata  freql 

•/.This  is  the  location  of  the  flexible  mode  sensors. 
sens_loc  =  str2num(get(sens_ed, 'string')) ; 

‘/.Some  locations  (nodes/anti-nodes)  make  the  problem 
'/.unobservable.  Check  for  this  and  alert  the  user  if  it  is  a  problem, 
[phi  ,phidot]=modeshpe(sens_loc5C250/100) ; 
if  (phidot  <  le-5) , 

disp( ’Flexible  pitch  rate  is  nearly  unobservable.’) 
disp(’ Change  the  sensor  location  ...  stopping’) 
elf 

7,  Message 

frame_title  =  uicontrol(gcf , . . . 

’style’ , ’text’ , . . . 

’position’ , [120  270  200  30],... 

’string’ , ’There  was  a  problem, ’ , . . . 

’foregroundcolor’ , [1  1  1],... 

’backgroundcolor’ , [0  0  0] ) ; 

Message 

frame.title  =  uicontrol(gcf , . . . 
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Figure  61.  Selection  of  output  sensors 


’ style’ , ’text’ , .  .  . 

’position’ , [120  240  200  30],... 

’string’ , ’see  the  command  window. ’ , . . . 

’foregroundcolor’ , [1  1  1],... 

’ backgroundcolor ’ , [0  0  0]  ) ; 
clear 
break; 
end; 

'/.Name  the  file  to  store  the  data, 
opfname  =  get (save_ed, ’string’) ; 

/Integer  1  if  model  is  aeroelastic. 
flexflag  =  get (ck_f lex, ’value') ; 

'/.Integer  1  if  the  model  has  a  canard, 
canardflag  =  get (ck_canard, ’value’ ) ; 

'/If  a  canard  is  present,  specify  its  canard  volume, 
if (canardflag==l) , 

split  =  str2num(get (canard_ed, ’string’)) ; 
else,  split  =  0;  end; 

'/.This  is  the  range  and  increments  of  tail  volume  to  check, 
vhlo  =  str2num(get(minvol_ed, ’string’)) ; 
vhhi  =  str2num(get (maxvol_ed, ’string’)) ; 
vhinc  =  str2num(get(incvol_ed, ’string’)) ; 

'/This  is  the  required  closed  loop  damping, 
damping  =  str2num(get(damp_ed, ’string’)); 
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theta  =  2'/,acos (damping)  ;  '/,  pole  placement  region  definition 
‘/.This  is  the  range  and  increment  of  actuator  rates, 
ratelo  =  str2num(get(minrate_ed, 'string')) ; 
ratehi  =  str2num(get(maxrate_ed, 'string')) ; 
rateinc  =  str2num(get(incrate_ed, 'string')) ; 

’/.This  specifies  which  sensors  to  use  for  output  feedback. 

%  An  integer  1  indicates  use  of  the  sensor.  Choices  are 

7,  flight  path  angle,  airspeed  angle  of  attack,  local 

’/.  pitch  rate,  local  pitch  angle.  The  default  is  full 

7,  information  output  feedback. 

gamaflag  =  get (ck.gama, 'value') ; 

asflag  =  get (ck_ as, 'value') ; 

aoaflag  =  get (ck_aoa, 'value') ; 

lprflag  =  get (ck_lpr, 'value') ; 

lpaflag  =  get (ck_lpa, 'value') ; 

fsflag  =  get (ck_fs, 'value') ; 

•/.  The  actuator  dynamics  are  specified  in  the  function 
7>  ACTAUTOR.M.  Canard  and  tail  actuators  do  not  have 
7*  to  be  the  same  although  dummy  dynamics  must  be 
*/.  specified  for  a  canard  even  if  not  used. 

[Aa,Ba,Ca,Da]  =  actuator; 
act=length(Aa) ; 

7»  For  the  first  order  actuator  modelused  here, 

*/.  specify  the  time  constant 
a_bw  =20; 

7,  The  angle  of  attack  excursion  is  equal  to  acos(gust/vt)  . 
gust  =  66;  %fps 

7,  The  equilibrium  point  is  specified  by  the  flight 
’/.  path  angle  and  true  airspeed  of  the  HSCT. 
gamma  =  0;  vt  =  422;  '/,  deg  fps 

'/.  Specify  tolerance  limit  for  the  eg  binary  search, 
tol  =  0.01; 

*/.  MATLAB  uses  the  matrix  variable  "region"  to  define 

7,  the  closed  loop  poleplacement  region.  Form  it 

'/.  based  on  user  inputs. 

region=zeros(4,8) ; 

region(l , 1)= .02+li; 
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region (2 , 2) =-40+1 i ; 
region(3,3)=0+2i; 
region(l,5)=l; 
region(2,6)=-l; 
region(3,7)=cos(damping) ; 
region (4, 8) =cos (damping) ; 
region (3, 8) =-sin (damping) ; 
region (4, 7)=sin(damping) ; 

#/„  Set  up  three  loops  to  map  the  design  space. 
'/,  First,  loop  through  range  of  tail  volumes, 
for  vh=vhlo:vhinc:vhhi; 


*/.  Initialize  some  variables  for  each  tail  volume. 
yemax=0;  ydemax=0;  ycmax=0;  ydcmax=0; 

X  Loop  through  the  range  of  actuator  rates, 
for  ratelimit  =  ratelo:rateinc:ratehi; 


•/„  Reset  eg  upper  and  lower  bounds  for  the 

'/.  binary  search. 

xegmax  =  1.0;  xegmin  =  0 ; 


'/,  Binary  search  on  c.g.  ;drop  out  when 

*/,  within  tolerance. 

while  (norm(xcgmax-xcgmin)  >  tol) ; 

save  cgvh  xcg  vh  split; 

7,  Load  appropriate  data  for  trim;  initial 
'/,  guesses  for  trim, 
load  trimdata 

'/,  Trim  at  eg  specified  and  linearize  at  peak 
%  of  gust  condition, 
if  (  flexflag  ==  1) , 

[xtrim,utrim,ytrim]  =  trim(,eom_b70w' ,x0,u0, . . . . 
[vt ;  gamma]  ,  []  ,  [1]  ,  [1 ;  2]  )  ; 
xtrim(2)  =  xtrim(2)  +  gust; 

[af ,bf ,cf ,df]  =  linmod(,eom_b70wJ ,xtrim,utrim) ; 
bf  =  bf (: ,1:2) ;  df  =  df(:,l:2); 
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xtrim(2)  =  xtrim(2)  -  gust; 
else, 

[xtrim,utrim,ytrim]  =  trim( ’ eom_b70r' ,xOr ,uO , . . . . 

[vt ;  gamma]  ,  []  ,  [1]  ,  [1 ;  2]  )  ; 
xtrim(2)  =  xtrim(2)  +  gust; 

[af ,bf ,cf ,df]  =  linmod( ’ eom_b70r’ ,xtrim,utrim) ; 
bf  =  bf ( : , 1 : 2) ;  df  =  df(:,l:2); 
xtrim(2)  =  xtrim(2)  -  gust; 
end; 

Vt  Connect  the  actuators  in  series. 

[A,B,C,D]  =  series(Aa,Ba,Ca,Da,af ,bf ,cf ,df ) ; 
Cm,n]=size(A) ; 

'/,  Place  the  actuator  states  after  the  plant  states. 
[n,p] =size(B) ; 

T1  =  [zeros(n-2,2)  eye(n-2) ; eye(2)  zeros(2,n-2)]  ; 

A  =  Tl’/.A/Tl ; 

B  =  IT/.B; 

C  =  C/Tl ; 

Vt  Similarity  transformation  used  to  make  local 
Vt  pitch  rate  and  local  body  angle  states  vice 
'/.  using  generalized  coordinates, 
if (flexflag==l) , 

[phi ,phidot] =modeshpe(sens_loc%250/100) ; 

T2  =  [eye (4)  zeros (4, 2+act) ; 

[0001  phidot  0]  zeros (1, act) ; 

[00100  phidot]  zeros (1 , act) ; 
zeros(act,6)  eye (act)] ; 
else,  T2=eye(n);  end; 

Abar  =  T2A/T2; 

Bbar  =  T2B; 

Cbar  =  C/T2; 

It  Form  output  matrix  based  on  user  specified  sensors. 
Vt  airspeed  is  Cbar(l,:) 

Vt  flight  path  angle  is  Cbar(2,:) 

Vt  angle  of  attack  is  Cbar(3,:) 

'/.  local  pitch  rate  is  5th  state  [0  0  0  0  1  0  0  0] 

*/.  local  pitch  angle  is  6th  state  [0  0  0  0  0  1  0  0] 
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C_select=  []  ; 
if  gamaf lag  ==  1 ; 

C_select  =  [C_select;Cbar(2, :)] ; 
end; 

if  asflag  ==  1; 

C.select  =  [C_select ;Cbar(l , : )] ; 
end; 

if  aoaflag  ==  1; 

C_select  =  [C_select;Cbar(3, :)] ; 
end; 

if  lprflag  ==  1; 

C_select  =  [C_select; [zeros (l,n-4)  1  0  0  0]]; 
end; 

if  lpaflag  ==  1; 

C_select  =  [C.select; [zeros (l,n-4)  010  0]]; 
end; 

if  fsflag  ==  1; 

C_select  =  eye(n) ; 
end; 

Cbar=C_select ; 

[n,m] =size(Bbar) ; 

[p,n]=size(Cbar)  ; 

7,  Use  the  angle  of  attack  excursion  to  define 
%  the  initial  condition. 

i0=[0  gust  0  0  zeros (l,n-4-act)  zeros (1, act)] ' ; 

y.i0=T'/,i0 ; 

'/.  Specify  rate  and  ampltude  constraints.  The 
'/,  rate  limit  comes  from  the 

%  GUI.  The  saturation  limit  is  set  at  30  degrees. 


ucmax  =  30;  uemax  =  30; 

udcmax  =  ratelimit;  udemax  =  ratelimit 


*/,  Finally,  form  the  LMIs. 
setlmis(  []  )  ; 

R  =  lmivar(l,  [n  1]);  '/.R*/. 

S  =  lmivar(l,  [n  1]);  ‘/,  S  */, 
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Ak  =  lmivar(2,  [n  n]);  '/,  Ak  '/, 

Bk  =  lmivar(2,  [n  p]  )  ;  '/,  Bk  '/, 

Ck  =  lmivar(2,  [m  n]);  '/,  Ck 

•/.  This  is  pole  placement  LMIs  formed  using 
°/,  LMI  region  matrix  REGION. 

[rr,rc] =size (region) ; 
if  rc~=2%rr, 

error( 'REGION  must  be  a  Mx(2M)  matrix'); 

end 

rl=0; 

7.  scan  each  region  (L,M)  (diagonal  blocks) 
while  rl<rr, 

bs=round(imag(region(rl+l,rl+l))) ; 
if  ~bs,  bs=rr-rl;  end 
L=real(region(rl+l :rl+bs,rl+l :rl+bs)) ; 
M=region(rl+l : rl+bs , rr+rl+1 : rr+r 1+bs) ; 
pole=newlmi;  %  pole  placement  in  the  region  (L,M) 
for  i=l:bs, 

nbi=2Xi-l;  7»  row  of  block  in  target  LMI 
off-diagonal  2x2  block 
for  j=l : i-1, 

nbj=2yoj-l;  7«  col  of  block  in  target  LMI 
lmiterm( [pole ,nbi ,nbj ,R] ,L(i,j) ,1); 

ImitermC [pole, nbi ,nbj ,R] ,Abar,M(i,j)) ; 
lmiterm( [pole, nbi, nbj ,R] ,M(j ,i) ,Abar') ; 
ImitermC [pole, nbi, nbj ,Ck] ,Bbar,M(i, j)) ; 
lmiterm([pole,nbi,nbj ,-Ck] ,M(j ,i) ,Bbar') ; 
ImitermC [pole, nbi+l,nbj+l,S] ,L(i,j) ,1) ; 
lmiterm( [pole ,nbi+l ,nbj+l ,S] ,M(i,j) ,Abar) ; 
lmiterm( [pole,nbi+l,nbj+l,S] ,Abar' ,M(j ,i)) ; 
lmiterm( [pole ,nbi+l ,nbj+l ,Bk] ,M(i , j ) ,Cbar) ; 
lmiterm( [pole,nbi+l ,nbj+l ,-Bk] ,Cbar' ,M(j ,i)) ; 
lmiterm( [pole,nbi+l,nbj ,0] ,L(i, j)) ; 

ImitermC [pole, nbi+1 ,nbj ,Ak] ,M(i,j),l) ; 

ImitermC  [pole, nbi+1, nb j ,0]  ,M(j  ,i)*/.Abar ’) ; 
ImitermC [pole, nbi, nbj+1,0] ,L(i,j)); 

ImitermC [pole, nbi, nbj +1,-Ak] ,M(j ,i) ,1) ; 
ImitermC  [pole  ,nbi  ,nbj+l ,  0]  ,M(i ,  j  )*/,Abar)  ; 
end 

7%  diagonal  2x2  block 

ImitermC  [pole, nbi,nbi,R] ,L(i,i) ,1); 


147 


lmiterm( [pole,nbi,nbi,R] ,Abar,M(i,i) , ’s') ; 
lmiterm( [pole,nbi ,nbi ,Ck] ,Bbar,M(i,i) 
lmiterm([pole,nbi+l,nbi+l,S] ,L(i,i) ,1) ; 
lmiterm([pole,nbi+l,nbi+l,S]  ,M(i,i)  ,Abar,  ’s’)  ; 
lmiterm([pole,nbi+l,nbi+l,Bk] ,M(i,i) ,Cbar, 's') ; 
lmiterm( [pole,nbi+l ,nbi ,0] ,L(i,i)) ; 
lmiterm( [pole,nbi+l ,nbi ,Ak] ,M(i, i) , 1) ; 
lmiterm([pole,nbi+l,nbi,0]  jMCi.iy/.Abar')  ; 
end 

rl=rl+bs ; 
end  7,  while 


*/,  This  is  x_0  LMI  from  the  invariat  elipsoid. 

x0_lmi  =  newlmi ; 

lmiterm  (  [-x0_lmi  1  10],  1) ; 

lmiterm(  [~xO_lmi  210],  iO) ; 

lmiterm(  [-x0_lmi  2  2  R],l,l); 

lmiterm (  [-x0_lmi  3  1  S] ,  1,  iO) ; 

lmiterm(  [-x0_lmi  320],  eye(n)); 

lmiterm(  [-x0_lmi  3  3  S] ,  1,  1); 

%  This  is  (u_max)  saturation  limit  elevator  LMI. 
umaxe.lmi  =  newlmi; 
lmiterm( [-umaxe_lmi  1  1  R] ,  1,1); 
lmiterm(  [-umaxe_lmi  2  1  0],eye(n)); 
lmiterm( [-umaxe.lmi  2  2  S]  ,  1,1); 
lmiterm( [-umaxe.lmi  3  1  Ck] ,  [0  l],l); 
lmiterm( [-umaxe.lmi  3  2  0],  oy,eye(n)); 
lmiterm(  [-umaxe_lmi  330],  uemax~2) ; 

y.  This  is  (u_max)  saturation  limit  canard  LMI. 

if (canardflag==l) , 

umaxc.lmi  =  newlmi; 

lmiterm( [-umaxc_lmi  1  1  R] ,  1,1); 

lmiterm(  [-umaxc_lmi  2  1  0],eye(n)); 

lmiterm( [-umaxc.lmi  2  2  S]  ,  1,1); 

lmiterm ( [-umaxc_lmi  3  1  Ck] ,  [1  0],1); 

lmiterm( [-umaxc.lmi  3  2  0],  OXeye(n)); 

lmiterm(  [-umaxc_lmi  330],  ucmax~2) ; 

end; 
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X  This  is  (ud_max)  actuator  rate  elevator  LMI. 
udmaxe_lmi  =  newlmi; 
lmiterm( [-udmaxe_lmi  1  1  R]  ,  1,1); 
lmiterm(  [-udmaxe_lmi  2  1  0],eye(n)); 
lmiterm( [-udmaxe.lmi  2  2  S] ,  1,1); 
lmiterm([-udmaxe_lmi  3  1  Ck] ,  [0  a_bw],l); 
lmiterm([-udmaxe_lmi  3  1  R] ,  [zeros(l ,n-l)  -a_bw],l); 
lmiterm([-udmaxe_lmi  320],  [zeros(l ,n-l)  -a_bw] ) ; 
lmiterm(  [-udmaxe.lmi  330],  udemax~2) ; 

X  This  is  (ud_max)  actuator  rate  canard  LMI . 

if (canardflag==l) , 

udmaxc_lmi  =  newlmi; 

lmiterm( [-udmaxc.lmi  1  1  R]  ,  1,1); 

lmiterm(  [-udmaxc.lmi  2  1  0],eye(n)); 

lmiterm([-udmaxc_lmi  2  2  S]  ,  1,1); 

lmiterm( [~udmaxc_lmi  3  1  Ck]  ,  [a_bw  0],1); 

lmiterm([-udmaxc_lmi  3  1  R] ,  [zeros(l ,n-2)  -a_bw  0],1); 

lmiterm([-udmaxc_lmi  320],  [zeros(l ,n-2)  -a_bw  0]); 

lmiterm(  [-udmaxc.lmi  330],  udcmax"2) ; 

end; 

lmisys  =  getlmis; 

*/,  Chech  to  see  if  the  set  of  LMIs  is  feasible. 

X  TMIN  should  be  negative  for  feasibility  and 
X  XFEAS  is  the  decision  vector  that  validates 
X  the  above  LMIs. 

[tmin,xf eas]  =  f easp (lmisys, [0  200  le8  00]); 

'/.  Values  of  TMIN  less  than  0  are  not  strictly  feasible 
%  but  seem  to  be  close  enough  to  work, 
if  tmin  <  le-4; 


X  Recover  the  LMI  variables . 

R  =  dec2mat (lmisys, xfeas, R) ; 

S  =  dec2mat (lmisys, xf eas, S) ; 
ak  =  dec2mat (lmisys, xf eas, Ak) ; 
bk  =  dec2mat (lmisys, xfeas, Bk) ; 
ck  =  dec2mat (lmisys , xfeas ,Ck)  ; 
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y,  Construct  the  controller  and  form  the  close  loop  system. 
[u,sd,v]=svd(eye(n)-  R'/.S) ;  '/,  factorize  I-RS 

sd=diag(sqrt(l ./diag(sd))) ; 

Ni=sd*v' ;  Mti=u*sd; 

Ac=Ni* (ak-S* (Abar)R-bkCbarR-S*Bbar*ck) *Mti ; 

Bc=Ni*(bk) ; 

Cc=(ck)*Mti; 

P  =  ltisys(Abar,Bbar,Cbar,zeros(p,m)) ; 
cont  =  ltisys(Ac,Bc,Cc,zeros(m,p) ) ; 
clsys  =  sift (P, cont ,m,p) ; 

[acl,bcl,ccl,dcl]  =  ltiss(clsys) ; 

%  Simulate  the  closed  loop  system  with  the  specified 
'/.  initial  condition  and  record  the  maximum  actuator 
%  amplitudes  and  rates. 

[ye,x,t]  =  initial(acl, [Bbar(: ,2) ;zeros(n,l)] _ _ 

[zeros(l ,n)  [0  l]*Cc] ,0, [iOjzeros (n, 1)] ) ; 
yemax  =  max(abs(ye)) ; 

[yc,x,t]  =  initial(acl, [Bbar(: ,2) ;zeros(n,l)] _ _ 

[zeros(l,n)  [1  0] *Cc] ,0, [iO; zeros (n, 1)] ) ; 
yemax  =  max(abs(yc)) ; 

[yde,x,t]  =  initial (acl , [Bbar(: ,2) ;zeros(n,l)] ,...  . 
[[zeros(l,n-l)  -a_bw] [0  a_bw]*Cc] ,0, [i0;zeros(n,l)]) ; 
ydemax  =  max(abs(yde)) ; 

[ydc,x,t]  =  initial(acl, [Bbar(: ,2) ;zeros(n,l)] , . . . . 

[ [zeros (l,n-2)  -a_bw  0] [a_bw  0]*Cc] ,0, [i0;zeros(n, 1)] )  ; 
ydemax  =  meix(abs(ydc))  ; 
eigvalue  =  eig(acl) 

data  =  [data;  xcg  ratelimit  vh  split  yemax  yemax  ydemax _ 

ydemax  tmin  utrim1  xtrim'  eigvalue']; 

V,  Move  eg  limit  aft . 
xegmin  =  xcg; 

V,  Otherwise,  move  eg  limit  forward, 
else, 

xegmax  =  xcg; 

end;  ‘/.SET  FEASIBLE,  if 

%  Chech  to  see  if  aft  eg  limit  is 
%  within  tolerance 

if  (  abs(xcgmax-xcgmin)  <  tol  |  xcg  >  .95  |  xcg  <  .05  ) 
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break; 

end;  7, WITHIN  TOLERANCE,  if 
end;  7, BINARY  CG  SEARCH,  while 

7.  This  is  the  aft  most  eg  for  the  rate,  tail 
7.  volume  combination, 
if (ydemax  ~=  0  |  ydemax  ~=  0) , 

cgrate=[cgrate;  vh  xcg  ydemax  yemax  ydemax  yemax  eigvalue’]; 
end; 

end;  7.RATE  SWEEP,  for 
end;  7.VH  SWEEP,  for 

7.  Change  to  the  DATA  directory  and  store  the 
7o  result  with  the  name  provided  from  the  GUI . 

7.  Return  the  user  to  the  GUI  directory, 
cd  .  . 
cd  data 

evalCC'save  ' , opf name ,'. mat  egrate  data  ']) 
cd  . . 
cd  gui 

The  above  code  is  associated  with  the  output  feedback  problem.  For  the  state 
feedback  problem,  the  code  is  very  similar.  The  essential  difference  is  in  the  LMI 
formulation  and  reconstruct ionof  the  controller.  That  part  of  the  code  from  Version 
A  substantially  different  from  Version  B  is  shown  next. 

7.  Form  the  state  feedback  LMIs 

setlmis([])  ; 

Y  =  lmivar(l,[n  1]  )  ; 

W  =  lmivar(2,[2  n]  )  ; 

7.  This  is  Lyapunov  lmi  with  real  part  constraint 
lyap  =  newlmi; 

lmiterm( [lyap  1  1  Y] ,  Abar+center*eye(n) ,  1,  's'); 
lmiterm( [lyap  1  1  W] ,  Bbar,  1,  's'); 

7.  This  is  the  pole  placement  LMI 
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pplac  =  newlmi; 

ImitermC [pplac  1  1  Y] ,  sin(theta/2)*Abar,  1,  's'); 

lm it erm( [pplac  1  1  H],  sin(theta/2)*Bbar ,  M,  's'); 

lmiterm( [pplac  2  1  Y]  ,  cos (theta/2) *Abar,  1); 

ImitermC [pplac  2  1  W]  ,  cos (theta/2) *Bbar,  M) ; 

ImitermC  [pplac  2  1  -Y] ,  -cos(theta/2) ,Abar' ) ; 
ImitermC [pplac  2  1  -W] ,  -cos(theta/2)*M’ ,Bbar’ ) ; 
ImitermC [pplac  2  2  Y] ,  sin(theta/2)*Abar ,  1,  ’s’); 

ImitermC [pplac  2  2  W]  ,  sin(theta/2)*Bbar,  M,  's’); 

’/.  This  is  the  Y  >  0  LMI 

ypos  =  newlmi; 

ImitermC [-ypos  1  1  Y] ,1,1); 

*/,  This  is  x_0  LMI 

xO_lmi  =  newlmi; 

ImitermC [-xO_lmi  1  1  0] ,  1); 

ImitermC [-xO_lmi  210],  iO) ; 

ImitermC [-x0_lmi  2  2  Y],l,l); 

*/.  This  is  ue_max  LMI 

uemax.lmi  =  newlmi; 

ImitermC  [-uemax_lmi  1  1  Y],  1,1); 

ImitermC [-uemax.lmi  2  1  W]  ,  C_amp_e,M); 

ImitermC [~uemax_lmi  220],  (uemax~2)); 

*/.  This  is  ude.max  LMI 

udemax.lmi  =  newlmi; 

ImitermC [~udemax_lmi  1  1  Y]  ,  eye(n) ,eye(n)) ; 
ImitermC [-udemax.lmi  2  1  W]  ,  C_rate_e*Bbar,M) ; 
ImitermC [-udemax.lmi  2  1  Y]  ,  C_rate_e*Abar,eye(n))  ; 
ImitermC [-udemax_lmi  220],  udemax~2) ; 

if  (canardflag  ==  1)  , 

*/,  This  is  uc_max  LMI 

ucmax_lmi  =  newlmi; 

ImitermC  [-ucmax.lmi  1  1  Y]  ,  1,1); 
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lmiterm([-ucmax_lmi  211],  C_amp_c,M); 
lmiterm( [-ucmax.lmi  2  2  0],  (ucmax~2)); 


°/,  This  is  udc_max  LMI 

udcmax.lmi  =  newlmi; 
lmiterm([-udcmax_lmi  1  1 
lmiterm([-udcmax_lmi  2  1 
lmiterm( [-udcmax_lmi  2  1 
lmiterm([-udcmax_lmi  2  2 
end; 

lmisys  =  getlmis; 


Y],  eye(n) ,eye(n)) ; 

W] ,  C_rate_c*Bbar,M) ; 

Y] ,  C_rate_c*Abar,eye(n) ) ; 
0]  ,  udcmax"'2); 


[tmin,xfeas]  =  f easp (lmisys, [0  200  le9  00]); 

if  tmin  <  le-4 

%  recover  LMI  variables 

y  =  dec2mat (lmisys, xf eas, Y) ; 
w  =  dec2mat (lmisys, xf eas, W) ; 

Kbar  =  w*M/y; 

%  record  initial  condition  responses 
if (canardflag  ==  1), 

yc  =  initial (Abar+Bbar*Kbar,Bbar,C_amp_c*. . . . 

Kbar, [0  0] ,i0) ; 
ycmax  =  max(abs(yc) ) ; 

yrc  =  initial (Abar+Bbar*Kbar ,Bbar( : ,1) ,... . 

C_rate_c* [Bbar*Kbar  +  Abar],0,i0); 

ydcmax  =  max(abs(yrc)) ; 

end; 

ye  =  initial (Abar+Bbar*Kbar , Bbar , C_amp_e*Kbar , [0  0],i0); 
yemajc  =  max(abs(ye)) ; 

yre  =  initial (Abar+Bbar*Kbar,Bbar(: ,2) ,C_rate_e* _ 

[Bbar*Kbar  +  Abar],0,i0); 
ydemax  =  max(abs(yre)) ; 
eigvalue  =  eig(Abar+Bbar*Kbar) ; 
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data  =  [data;  xcg  ratelimit  vh  split  ycmax  yemax  .... 

ydcmax  ydemax  tmin  utrim'  xtrinP  Kbar(l,:)  Kbar(2,:)  eigvalue’] ; 


Again,  for  the  gust  penetration/state  feedback  problem  (Version  C),  the  code 
is  very  similar.  Principally,  the  formation  of  the  linear  model  (which  includes  gust 
dynamics)  is  different.  After  that,  the  code  proceeds  in  a  similar  manner  to  the  angle 
of  attack/state  feedback  problem  (Version  A).  That  part  of  the  code  from  Version  C 
substantially  different  from  Version  A  is  shown  next. 

•/.  Gust  penetration  model  formulation, 

'/,  including  gust  dynamics  and 
%  LMI  formulation. 

*/,  Load  appropriate  data  for  trim 
load  trimdata 

[xtrim,utrim,ytrim]  =  trim( ' eom_b70r ’ ,xOr,uO, . . . . 

[vt ;  gamma]  ,  []  ,  [l]  ,  [1;2]  ) ; 

'/.  Linear  model  for  given  cg/vh 

[af ,bf ,cf ,df]  =  linmod( ’ eom_b70r> ,xtrim,utrim) ; 
bf  =  bf ( : ,2)  ;  df  =  df(:,2); 


y,  Connect  the  actuators  in  series 

[A , B , C , D]  =  series(Aa,Ba,Ca,Da,af ,bf ,cf ,df) ; 

C=[]  ;  D=  []  ; 

y,  Place  the  actuator  states  after  the  plant  states 
[n,p]=size(B) ; 

T  =  [zeros(n-l,l)  eye(n-l) ; eye(l)  zeros (1 ,n-l)]  ; 

A  =  T*A/T; 

B  =  T*B; 

C=eye(n) ; 

D=zeros(n,p) ; 

5C  Add  gust  states  to  end  of  model 
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Ag=zeros (n+2 , n+2) ; 

Ag (n+ 1 , n+ 1 ) =lambdal ; 

Ag(n+2 ,n+2)=lambda2 ; 

Ag(l : 5,n+l)=-A(l : 5,2) ; 
Ag(l:5,n+2)=-A(l:5,2); 

Abarl=[A  zeros(n,2) ;zeros(2,n+2)]  +  Ag; 
Bbarl=[B;0;0] ; 

Cbar=eye(n+2) ; 

Dbar=zeros(n+2,p) ; 

T  =  eye (n+2) ; 

T(2,n+1)  =  -1; 

T(2 ,n+2)  =  -1; 

Abar=T*Abarl/T ; 

Bbar=T*Bbarl ; 


'/,  Specify  Static  Controller  Structure 
M  =  [eye(n)  zeros(n,2);  zeros (2, n+2)] ; 

Y,  Define  gust  i.c. 

i0=[0  0  0  0  zeros (1 ,n-4-act)  zeros(l,act)  -gust  gust]  ’ ; 
'/„  Rate/Amplitude  selection  matrices 
C_amp_e  =  1;  C_rate_e  =  [zeros ( 1 ,n-act)  1]; 

’/.  modify  for  gust  states 
C_rate_e  =  [C_rate_e  0  0] ; 

%  AOA  output  matrix 

C.alpha  =  (57 .3/vt)* [0  1  zeros(l3n-2)  0  0]; 

*/.  Specify  rate  and  amplitude  constraints 

uemax  =  amplimit; 
udemax  =  ratelimit; 
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X  form  the  LMIs 


setlmis(  []  )  ; 

Y  =  lmivarCl, [n  1 ; 2  1]); 

W  =  lmivar(2, [1  n+2] )  ; 

*/,  This  is  Lyapunov  lmi  with  real  part  constraint 


lyap  =  newlmi; 

lmiterm( [lyap  1  1  Y],  Abar+center*eye(n+2) ,  1,  's'); 
lmiterm( [lyap  1  1  W]  ,  Bbar,  M,  's'); 


%  This  is  the  pole  placement  LMI 


pplac  =  newlmi; 
ImitermC [pplac  1  1 
lmiterm( [pplac  1  1 
ImitermC [pplac  2  1 
ImitermC [pplac  2  1 
lmiterm( [pplac  2  1 
ImitermC [pplac  2  1 
ImitermC [pplac  2  2 
ImitermC [pplac  2  2 


Y] ,  sin(theta/2)*Abar,  1,  's'); 

W] ,  sin(theta/2)*Bbar,  M,  ’s’); 

Y] ,  cos (theta/2) *Abar,  1); 

W] ,  cos (theta/2) *Bbar,  M)  ; 

-Y] ,  -cos (theta/2) ,Abar’) ; 

-W] ,  -cos (theta/2) *M> ,Bbar' ) ; 

Y] ,  sin(theta/2)*Abar,  1,  's'); 

W] ,  sin(theta/2)*Bbar,  M,  ’s'); 


%  This  is  the  Y  >  0  LMI 


ypos  =  newlmi; 

ImitermC [-ypos  1  1  Y],l,l); 

y,  This  is  x_0  LMI 

xO_lmi  =  newlmi; 

ImitermC [~xO_lmi  1  1  0] ,  1) ; 
ImitermC [-x0_lmi  21  0],  iO) ; 
ImitermC [-x0_lmi  2  2  Y] ,1,1) ; 

*/,  This  is  ue_max  LMI 


uemax_lmi  =  newlmi; 

ImitermC [-uemax_ lmi  1  1  Y] ,  1,1); 
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lmiterm([-uemax_lmi  2  i  W] ,  C_amp_e,M); 
lmiterm( [-uemax_lmi  220],  (uemax~2)); 

•/.  This  is  alpha_max  LMI 


'/.amax.lmi  =  newlmi; 
y,lmiterm(  [-amax_lmi  1  1  Y]  ,  1,1); 
y,lmiterm( [~amax_lmi  2  1  Y]  ,  C_alpha,l); 
y,lmiterm([-amax_lmi  2  2  0],  (alphalimit~2) ) ; 

'/,  This  is  ude_max  LMI 


udemax_lmi  =  newlmi; 
lmiterm( [-udemax.lmi  1 
lmiterm(  [-udemax_lmi  2 
lmiterm([-udemax_lmi  2 
lmiterm( [-udemax_lmi  2 


1  Y] ,  eye(n+2) ,eye(n+2)) ; 

1  W] ,  C_rate_e*Bbar,M) ; 

1  Y] ,  C_rate_e*Abar,eye(n+2)) ; 

2  0] ,  udemax"2) ; 


lmisys  =  getlmis; 

[tmin,xfeas]  =  f easp (lmisys, [0  200  le9  0  0] ) ; 

if  tmin  <  le-4 

y,  recover  LMI  variables 

y  =  dec2mat (lmisys, xf eas, Y) ; 
w  =  dec2mat (lmisys, xf eas, W)  ; 

Kbar  =  w*M/y; 

7,  record  initial  condition  responses 

ye  =  initial (Abar+Bbar*Kbar, Bbar, ... . 
C_amp_e*Kbar,0,i0) ; 
yemax  =  max(abs(ye) ) ; 

yre  =  initial (Abar+Bbar*Kbar, Bbar, _ 

C_rate_e* [Bbar*Kbar  +  Abar],0,i0); 
ydemax  =  max(abs(yre)) ; 

eigvalue  =  eig(Abar+Bbar*Kbar) ; 
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When  the  process  has  completed  for  the  range  of  values  specified  for  either  Version 
A,  B,  or  C,  the  user  is  returned  to  the  MATLAB  command  prompt.  The  program 
results  will  have  been  stored  in  the  DATA  directory  using  the  name  supplied  by  the 
user.  The  user  is  free  to  view  them  or  generate  another  data  file. 

3.  VIEWING  A  DATABASE 

After  a  database  has  been  generated  for  a  particular  aircraft  definiton,  the 
program  viewJt.m  is  used  to  view  the  data.  The  program  view.it. m  presents  the 
graphical  user  interface  shown  in  Figure  62. 


Figure  62.  Interface  called  by  viewJt.m 

The  interface  is  fairly  self  explanatory.  The  options  are  to  view  the  three 
dimensional  Tail  Sizing  Design  Space,  or  to  view  a  2D  slice  of  the  Tail  Sizing  Design 
Space.  Additionally,  the  user  can  specify  a  second  database,  in  order  to  compare  two 
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different  aircraft  definitions  on  a  single  graph.  If  a  two  dimensional  view  is  desired, 
then  the  user  must  specify  the  actuator  rate  limit  used  to  intersect  the  lower  surface 
of  the  Tail  Sizing  Design  Space.  When  ready,  the  user  selects  the  button  labeled 
’’Show  It,”  which  executes  the  program  in  the  GUI  directory  called  showdata.m. 


xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


X  Showdata.m 

xxxxxxxxxxxxxxx 

yi=[];  yi_e=[] ; 


xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


X  Determine  the  user  preferences  and  data  file 
X  names  from  the  GUI.  Go  load  the  file  from 
X  the  DATA  directory. 
ipfnamel=get (loadl.ed,  ' string' ) ; 
ipfname2=get (load2_ed, ' string' ) ; 
cd  .  . 
cd  data 

eval(['load  ' , ipfnamel , ' .mat '] )  ; 

cgrateA=cgrate ; 

numfiles=l; 

if  (  get (rb_file2, 'value')  ==  1  ) , 
eval(['load  ' ,ipfname2, ' .mat']  )  ; 
cgrateB=cgrate; 
numf iles=numf iles+1 ; 
end; 
cd  .  . 
cd  model 


X  This  is  the  target  actuator  rate:  the  level  plane 
X  slicing  the  surface. 

udselect=str2num(get (limit_ed, 'string')) ; 

X  This  records  the  user  choice  of  either  a  3D  or  2D  plot, 
if  (  get (rb_3d, 'value' )  ==  1) 
choice=l ; 
else, 
choice=0; 
end; 

X  This  captures  the  axis  limits  from  the  GUI. 
udmin=str2num(get (minrate.ed, ' string' ) ) ; 
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udmax=str2num(get (maxrate.ed, 'string')) ; 
cgmin=str2num(get (mincg_ed, ' string ’ ) )/lOO ; 
cgmax=str2num(get (maxcg_ed, ' string' ) )/100 ; 
vhmin=str2num(get (minvh_ed, 'string')) ; 
vhmax=str2num(get(maxvh_ed, 'string')) ; 

7  This  captures  the  view  point  preference. 
azim=str2num(get(azim_ed,  'string')) ; 
elev=str2num(get (elev_ed, ' string' ) ) ; 

7  The  user  may  wish  to  compare  to  aircraft  definitions 
7  side  by  side.  Loop  for  1  or  2  files, 
for  comp=l:numfiles; 
if  (comp==l) , 
cgrate=cgrateA ; 
else, 

cgrate=cgrateB ; 
end; 

’/.  Preprocess  the  data  by  parsing  by  tail  volume. 

[m,n]=size(cgrate) ; 

num_vh=l ; 

index (num_vh)  =  1  ; 

for  i=l:m-l, 

if  (  cgrate(i , 1)  <  cgrate(i+l , 1)  ), 
index (num_vh+l)=i+l ; 
num_vh=num_vh+l ; 
end; 
end; 

index (num_vh+l)=m+l ; 
file='cgrate' ; 
for  i=l:num_vh, 
p=index(i) ; 
q=index(i+l)-l; 

eval([file,int2str(i) , '  =  ', file, ' (p:q, :);'])  ; 
end; 

7  Curve  fit  the  rate  vs.  eg  data  for  each  tail 
7,  volume.  The  curve  fit  uses  a  simplex  nonlinear 
7,  fit.  The  general  form  of  the  function  to  fit 
7  to  is  two  exponentials, 
global  DATA 
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file2='DATA' ; 
f ile3=>c' ; 
lin=  []  ;  nlin=[]  ; 
for  k=l:num_vh; 

eval( [f ile2, ’  =  [J ,f ile, int2str(k) , ‘ (: ,2)  ’,.... 

file, int2str(k) , ’ ( : ,5)] ;  ']) 

lam  =  [10]’; 

trace  =  0; 

tol  =  .1; 

lambda  =  f mins ( 'myf it ’ ,1am, [trace  tol]); 

A  =  zeros (length (DATA ( : ,1)) ,length(lambda)) ; 
for  j  =  1 : length (lambda) 

A(:,j)  =  exp(-lambda(j)*DATA( : ,1)) ; 
end 

eval([file3, »  =  A\DATA( : ,2) ; »] ) ; 
lin=[lin  c] ; 
nlin= [nlin  lambda] ; 
end 

’/.  Repeat  the  process,  this  time  curve  fitting 
'/,  for  elev  amp  vs.  eg  for  each  tail  volume, 
global  DATA.E 
fi^^DATA.E' ; 
file3=,c'; 

lin_e=[];  nlin_e=[]  ; 
for  k=l:num_vh; 

eval( [f ile2, *  =  [’ ,file,int2str(k) , J ( : ,2)  ',.... 

f ile, int2str(k) , ' ( : ,6)] ;  J]) 

lam  =  [10]’; 

trace  =  0; 

tol  =  .1; 

lambda  =  f mins ('myfit' ,1am, [trace  tol]); 

A  =  zeros(length(DATA_E( : ,1)) , length (lambda)) ; 
for  j  =  1 : length (lambda) 

A( : ,  j )  =  exp(-lambda(j)*DATA_E( : , 1)) ; 
end 

eval( [file3, ’  =  A\DATA_E(: ,2) ; '] ) ; 
lin_e=[lin_e  c] ; 
nlin_e=[nlin_e  lambda]; 
end 

'/,  Sample  the  functions  determined  above  at  uniform 
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'/,  values  of  eg. 
f ile4=,vh' ; 
t=cgmin: .01:cgmax; 
t=t’ ; 

for  z=l:num_vh; 
for  j  =  1: length (t) 

r(j,z)  =  lin(l,z)*exp(-nlin(l,z)*t(j))  +  .... 
lin(2,z)*exp(-nlin(2,z)*t (j))  ; 
e(j,z)  =  lin_e(l,z)*exp(-nlin_e(l,z)*t(j))  + 
lin_e(2,z)*exp(-nlin_e(2,z)*t (j )) ; 
end; 

eval([file4, 1 (: ,z)  =  ' , file, int2str(z) , ’ (1,1)*. .. . 
ones (length (t) , 1) ;  '  ]) 
end; 

'/,  This  is  the  resulting  mesh.  It  could  be  plotted 
V,  as  is,  but  below  we'll  decrease  the  mesh  size 
%  using  linear  interpolation. 

ALLDATA=  []  ; 

ALLDATA_E=  []  ; 
for  j=l:num_vh, 

ALLDATA= [ALLDATA  t  vh(:,j)  r(:,j)]; 

ALLDATA_E= [ALLDATA_E  t  vh ( : , j )  e (  :  ,  j ) ]  ; 
end; 

%  Linearly  interpolate  the  mesh  between  the  values  of 

*/,  tail  volume. 

ht=  []  ; 

amp=  []  ; 

vol=[]  ; 

for  k=l: ((num_vh)-l)  ; 
xi=vh(l,k) : .01: (vh(l,k+l)-.01)  ; 
x=vh(l ,k:k+l) ; 
for  j=l :length(t) 
y=r(j ,k:k+l) ; 
y_e=e(j ,k:k+l) ; 
yi(: ,j)»interpl(x,y,xi) ; 
yi_e(: ,j)=interpl(x,y_e,xi); 
end 

ht= [ht  yi ' ] ; 
amp= [amp  yi_e'] ; 
vol=[vol;xi'] ; 
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end 

ht=[ht  r(: ,num_vh)] ; 
amp= [amp  e ( : , num_vh) ] ; 
vol=[vol;vh(l,num_vh)] ; 

7,  Plot  the  data, 
if  (comp==l) , 
figure 
end; 

if  (choice  ==  1) , 

'/,  This  is  the  3D  plot  of  the  data. 
htt=ht ' ; 

[m,n] =size(htt) ; 
for  p=l :m; 
for  q=l:n; 

if  (htt(p,q)  >  udmax  |  htt(p,q)  <  0), 
ht (q,p)=nan; 
end; 
end; 
end; 

if  (comp==l) , 
surf (t*100,vol,ht') 

axis ( [cgmin* 100  cgmax*100  vhmin  vhmax  udmin  udmax]) 

caxis ( [udmin  udmax] ) 

grid; 

view(azim,elev) 

'/,  This  is  the  rate  limit  slice. 
ts=cgmin+.l: .01 :cgmax-. 1; 

[mm , nn] =s ize (ht ) ; 

pln=ones (length (ts) ,nn) *udselect ; 

C=ones (length(ts) ,nn) *2 ; 
surf ace(ts*100, voicin'  ,C’)  ; 
xlabel  ( ’  c .  g .  ('/.c)  ' ) 
ylabel(>tail  volume') 
zlabel(' actuator  rate  (deg/s)') 
else, 

surf (t*100 , vol ,ht ' ) 
end; 

else. 


163 


%  This  is  the  2D  intersection  of  the  target  rate  limit 
%  and  surface. 
vhsc=[]  ; 
cgsc=[]  ; 

[m,n]=size(ALLDATA) ; 
for  j=l :3:n 
xi  =  udselect; 

yi  =  spline (ALLDATA ( : , j+2) , ALLDATA ( :  ,  j) ,xi) ; 
vhsc=[vhsc  ALLDATA(1 , j+1)] ; 
cgsc=[cgsc  yi] ; 
end 

’/.  Fit  a  curve  to  the  points  representing  the  2D  graph. 
CGVH= [cgscJ  vhsc’]; 

[p,s]=polyf it(CGVH( : ,1) ,CGVH(: ,2) ,2) ; 
lam  =  [10]' ; 
trace  =  0; 
tol  =  . 1; 

lambda  =  fminsC'myf it' ,1am, [trace  tol]); 

A  =  zeros (length(CGVH( : ,1)) , length (lambda))  ; 
for  j  =  1 : length (lambda) 

A(:,j)  =  exp(-lambda(j)*CGVH(: ,1))  ; 
end 

c  =  A\CGVH( : ,2) ; 

lin_s=c; 

nlin_s=lambda; 

V,  Sample  the  fitted  function  at  uniform  eg  increments. 
vhsc=[]  ; 
cgsc=[]  ; 

t=cgmin : . 05 : cgmax ; 
t=t> ; 

for  j  =  1: length (t) 

vhsc(j , 1)  =  lin_s ( 1 , l)*exp (~nlin_s (1 , 1) *t ( j ) )  + 
lin_s (2 , 1) *exp (-nlin.s (2 , 1) *t ( j ) ) ; 
end; 

cgsc=t*100; 

’/.  Plot  the  2D  intersection  of  the  level  plane  and  surface, 
if (comp==l) , 

plot (cgsc,vhsc, 'o' ,cgsc,vhsc) ; 
grid; 
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axis([cgmin*100  cgmax*100  vhmin  vhmax] ) ; 
xlabelf’c.g.  (*/,c)’) 
ylabel(’tail  volume’) 
else , 

plot(cgsc,vhsc, ,cgsc,vhsc) ; 
text(cgmax-. 15,vhmin+.025, ’*  =  2nd  File’); 
end; 
end; 

if  (numf iles==2) , 
hold; 

clear  yi  yi_e  r  e  cgrate 
end; 

end; 

'/,  Return  the  user  to  the  GUI  directory, 
cd  .  . 
cd  gui 


4.  THE  DYNAMIC  AIRCRAFT  MODEL 

The  model  used  by  the  Tail  Sizing  Design  Tool  simulates  the  longitudinal  mo¬ 
tion  of  a  conventional  aircraft.  The  configuration  may  or  may  not  include  a  canard. 
The  upper  shell  of  the  dynamic  model  is  either  the  Simulink  file  tomJblOr.m ,  for 
rigid-body  dynamics,  or  the  file  eornb70w. rn.  for  flexible  body  dynamics.  The  trim, 
and  linearize  routines  supplied  by  MATLAB  are  use  to  determine  the  equilibrium 
point,  and  generate  a  linear  model  for  the  LMI  problem  formulation.  The  simulink 
shells  above  call  the  function  eombJOr,  or  eomb70w ,  in  order  to  compute  the  deriva¬ 
tive  of  the  models’  states.  The  computation  is  based,  in  part,  on  the  stability  and 
control  derivatives  supplied  by  the  user,  which  are  retrieved  via  a  nested  function 
call  explained  later.  The  description  of  eomb70w  follows,  as  the  Simulink  shell  is  self 
explanatory. 


mmrammmmramm 

•/.  function:  eomb70w.m  '/, 


165 


%  The  vector  passed  to  the  function  is  the 
'/.  vehicles'  states, 
function  accel  =  eomb70w(x) 

%  Retrieve  the  center  of  gravity  ,  tail  volume 
y,  and  canard  volume  parameters 

load  cgvh; 

*/0  Retrieve  the  normalized  aircraft  derivatives 
'/,  at  the  center  of  gravity  and  control  volumes 
%  specified.  Retrieve  the  flexible  mode  frequency. 

[rho,a,CDO,CL,CM,QF , omegai,mi,Ti,s,b,c,m,To,Iyy,lh,lc] 
b70dat aw (xcg,vh, split) ; 
load  flexdata 


*/,  Parse  the  vector  passed  to  the  function  into 
%  its  components  and  use  them  to  compute  terms 
y,  necessary  to  "denormalize"  the  force  and  moment 
X  coefficients. 

dc  =  x(l);  de  *  x(2)  ;  dtrt  =  x(3); 

u  =  x(4);  w  =  x(5) ;  q  =  x(6); 

theta  =  x(7);  eta  =  x(8);  etad  =  x(9) ; 


'/,  Calculate  the  total  velocity,  vt,  and  dynamic 
X  pressure  gravity  (assumed  constant)  and 
y.  angle  of  attack. 


vt 

qbar 

g 

alpha 

norml 

norm2 

norm3 

norm4 

norm5 

norm6 


=  (u~2  +  w~2) “ .5; 
=  .5*rho*(vt~2) ; 

=  32.2; 

=  asin(w/vt) ; 

=  rho*vt~2*s/2; 

=  rho*vt*s*c/4; 

=  rho*vt"2*s*c/2; 
-  rho*vt*s*c“2/4; 
=  rho*vt~2*s*c/2; 
=  rho*vt*s*c'2/4; 


X  Based  on  the  stability  and  control  derivatives 
X  retrieved  by  the  function  {\em  b70dataw.m>,  the 
X  coefficients  above  and  the  vehicles'  states, 
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'/,  the  total  lift,  drag,  pitching  moment  and  elastic 
%  generalized  force  on  the  vehicle  is  computed. 

L  =  norml*(CL(l)  +  CL(2)*alpha  +  CL(7)*de  +  CL(8)*dc  +  .... 

CL(5)*eta)  +  norm2*(CL(3)*0  +  CL(4)*q  +  CL(6)*etad); 

Ln  =  L/ (qbar*s) ; 

Dn  =  (CDO  +  1 . 01*Ln~2/pi/a) ; 

D  =  Dn*qbar*s; 

M  =  norm3*(CM(l)  +  CM(2)*alpha  +  CM(7)*de  +  CM(8)*dc  +  .... 

CM(5)*eta)  +  norm4*(CM(3)*0  +  CM(4)*q  +  CM(6)*etad); 

Qeta  =  norm5*(QF(l)  +  QF(2)*alpha  +  QF(6)*de  +  QF(7)*dc  .... 

+  QF(4)*eta)  +  norm6*(QF(3)*q  +  QF(5)*etad); 

'/,  The  lift,  drag  and  gravity  force  are  resolved  in 
'/.  the  body  reference  frame.  Then,  the  linear,  angular 
%  and  elastc  accelerations  are  computed  in  the  body 
%  reference  frame. 

udot  =  -q*w  -  g*sin(theta)  +  (-cos (alpha) *D  +.... 
sin(alpha)*L  +  To*dtrt)/m; 

wdot  =  q*u  +  g*cos (theta)  +  (sin(alpha)*D  -  _ 

co  s ( alpha) *L ) /m ; 
qdot  =  M/Iyy; 

etadd  =  -omegai(l)~2*eta  -  2*omegai*Ti*etad  +  Qeta/mi; 

Notice  that  the  prior  program  utilized  a  nested  function  call  to  retrieve  the 
total  vehicle  stability  and  control  derivatives.  These  derivates  are  supplied  by  the 
function  b70dataw ,  which  provide  user  supplied  values  of  the  wing-body,  tail  and 
canard  contributions  to  lift  and  pitch.  If  a  flexible  mode  is  retained,  the  user  must 
also  specify  the  mode  shape,  in  vacuo  frequency,  and  generalized  mass  of  the  first 
bending  mode.  Presented  below  is  data  for  the  generic  HSCT  model  termed  Ref  A. 
When  the  flexible  mode  is  included,  the  model  is  termed  Ref  B. 


'/,  function:  b70dataw.m  % 
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y.  To  begin,  the  user  must  specify  the  physical 
%  description  of  the  aircraft  including  the 
'/,  frequency  and  generalized  mass  associated 
#/,  with  the  flexible  mode. 

*/,  paramet er/ value/ units/descript i on 

G  =  32.174;  %  gravitational  constant 

g  =  G;  '/,  fps~2 

W  =  480425;  '/„  lbs 

m  =  W/G;  */,  slugs 

Iyy  =  2 . 181e7 ;  '/.  slug-ft'2 

S  =  6298;  '/,  ft '2 

c  =  78.5;  '/.ft 

cbar  =  c;  */,  c 

b  =  105;  '/,  wing  span 

U  =  422;  '/.  fps 

rho  =  .0023769;  '/.  density 

Q  =  .  5*rho*U*U;  '/.  lbf/ft*ft 

a  =  1.751;  y,  aspect  ratio 

lh  =  85;  '/,  tail  moment  arm  to  ac 

lc  =  85;  y,  canard  moment  arm  to  ac 

ih  =  0;  '/,  tail  incidence  angle 

To  =  1000;  %  nominal  thrust  lbs 

cloc  =  .05;  %  canard  location 

tloc  =  .95;  '/,  aero  center  of  tail  location 

vc  =  split;  '/,  canard  volume 

vh  =  vh;  */,  tail  volume 

omegai  =  6.29;  flexible  frequency 

mi  =  [500]  ;  '/,  generalized  mass 

Ti  =  .02;  %  flexible  damping 

'/.  The  stability  and  control  derivatives  of  the 
’/,  canard,  wing-body  and  tail  are  entered.  Those  listed 
'/,  below  are  for  a  generic  HSCT  "like"  aircraft  termed 
y,  ref  A.  Following  the  development  of  Wykes 'method, 

'/.  the  user  can  enter  terms  that  residualize  the  effects 
5C  of  the  elastic  motion.  In  this  case,  only  the  rigid 
'/,  body  derivatives  have  been  entered.  The  nomenclature 
y,  uses  either  no  extension  or  the  extension  (_r)  to 
y  indicate  that  the  term  is  a  rigid  body  term.  The 
y  extension  (_e)  is  used  for  flexible  body  terms. 


'/,  Finally,  the  extension  (_eor)  is  used  for  terms  that 
%  scale  the  rigid  body  terms  due  to  flexible  effects. 


7,  Drag  data 
CDO  »  0.002; 

CDU  =  0.0; 

y,  Lift  data 
clift .total  =  0.161; 
clift_vh_term  =  0.801642; 
clift_wb_af 0_r  =  0.04; 
clift_dwb_af 0_er  =  0.0; 
clift _wb_af_r  =  0.0422; 
clift _wb_af_eor  =  1.0; 
clift _wb_q_r  =  0.0558; 
clift _wb_q_eor  =  1.0; 
clift _wb_adf _r  =  0.0; 
clift _wb_adf_eor  =  0.0; 
clift _wb_n_e  =  0.0; 
clift _wb_dq_e  =  0.0; 
clift _h_q_r  =  0.123; 
clift _h_q_eor  =  1.0; 
clift _h_adf_e  =  0.0; 
clift_h_n_e  =  0.0; 
clift _h_dq_e  =0.0; 
clift_h_ah0_e  =  0.0; 
clift_h_ah_r  =  0.0455; 
clift _h_ah_eor  =  1.0; 
clift_e_af0_r  =  1.8; 
clift_e_af0_er  =  0.0; 
clift_dah_dloadh  =  0.0; 
clift _e_af_r  =  0.71; 
clift_e_af_eor  =  1.0; 

'/.  Lift  Data  -  Canard 
clift_c_q_r  =  0.123; 
clift_c_q_eor  =  1.0; 
clift_c_adf _e  =  0.0; 
clift_c_n_e  =  0.0; 
clift_c_dq_e  =0.0; 
clift_c_ac0_e  =  0.0; 
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clift_c_ac_r  =  0.0455; 
clift_c_ac_eor  =  1.0; 
clift_dac_dloadc  =  0.0; 

CLU  =  0; 

'/,  Pitching  moment  data 
cm_total  =  -0.063618; 
cmO_wb_r  =  0.0; 
cm0_wb_er  =  0.0; 
dcm_dcl_wb_r  =  0.02; 
dcm_dcl_wb_er  =0.0; 
cm_wb_q_r  =  -0.0298; 
cm_wb_q_eor  =  1.0; 
cm_wb_adf_r  =  -0.0067; 
cm_wb_adf _eor  =  1.0; 
cm_wb_n_e  =  -0.01; 

cm_wb_dq_e  =  0.0; 

CMU  =  0.0; 

V,  Based  on  theses  derivatives  and  the  physical 
*/,  characteristics  of  the  aircraft,  some  useful 
5C  coefficients  are  calculated. 

kl  =  cbar/ (2*U) ; 
k2  =  cbar*vh/lh; 
k3  =  S*cbar/lh; 
k2_c  =  cbar*vc/lc; 
k3_c  =  S*cbar/lc; 

y  Tail  contribution  coefficients 

Alpha.l  =  clift_h_ah0_e. . . 

/ (l-(clift_h_ah_r*clift_h_ah_eor*clift_dah_dloadh*Q*vh*k3)) ; 
Alpha_2  =  -(clift_h_ah_r*clift_h_ah_eor*. . . . 
(clift_e_af0_r+clift_e_af0_er)) . . . 

/ (l-(clift_h_ah_r*clift_h_ah_eor*clift_dah_dloadh*Q*vh*k3)) ; 
Alpha_0  =  Alpha. 1  +  Alpha_2; 

Alpha_ih=  clift _h_ah_r*clift_h_ah_eor .  .  . 

/ (l-(clift_h_ah_r*clift_h_ah_eor*clift_dah_dloadh*Q*vh*k3)) ; 
Beta  =  (clift _h_ah_r*clift_h_ah_eor* . . . . 
(l-clift_e_af_r*clift_e_af_eor) ) . . . 

/ ( 1- (clift _h_ ah_r*clif t_h_ah_eor*clif t_dah_dloadh*q*vh*k3) ) ; 
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#/.  Canard  contribution  coefficients.  Note,  the 
%  canard  is  treated  simply  as  a  forward  tail. 

Alpha_0c=  clift_c_acO_e . . . 

/  (l-(clift_c_ac_r*clift_c_ac_eor*clift_dac_dloadc. . . . 
*Q*vc*k3_c) ) ; 

Alpha_ic=  clift_c_ac_r*clift_c_ac_eor. . . 

/  (l-(clift_c_ac_r*clift_c_ac_eor*clift_dac_dloadc. . . . 
*Q*vc*k3_c) ) ; 

Beta_c  =  (clift_c_ac_r*clift_c_ac_eor*(l-clift_e_af_r . . . . 
*clift_e_af_eor)) . . . 

/  (l-(clift_c_ac_r*clift_c_ac_eor*clift_dac_dloadc*Q*vc*k3_c)) ; 

'/.  Finally,  the  total  vehicle  stability  and  control 
%  derivatives  are  computed  based  on  the  canard, 

*/,  wing-body  and  tail  contributions.  The  build  up 
y  is  based  on  a  standard  development  presented  in 
'/,  many  aircraft  dynamics  texts;  here  I  used  Etkin. 

%  The  computation  of  the  elastic  stability  and  control 
'/,  derivatives  follow  the  development  earlier  in  this  text. 

%  Form  static  stability  derivaties  needed  for  trim. 

CLO  =  clift _wb_afO_r  +  clift_dwb_afO_er  +  .... 
k2*Alpha_0  +  k2_c*Alpha_0c; 

CLA  =  57.3*(clift_wb_af_r*clift_wb_af_eor  +  .... 
k2*Beta  +  k2_c*Beta_c) ; 

CLIS  =  k2*Alpha_ih; 

CLIC  =  k2_c*Alpha_ic; 

CMO  =  cmO_wb_r  +  cmO_wb_er  +  (dcm_dcl_wb_r  +  .... 
dcm_dcl_wb_er)* (clift _wb_afO_r  +  clift_dwb_afO_er) _ 

-  Alpha_0*vh  +Alpha_Oc*vc  +  CL0*(xcg-.25) ; 

CMA  =  57.3*((dcm_dcl_wb_r  + 

dcm_dcl_wb_er)* (clift _wb_af_r*clift_wb_af _eor) . . . 

-  Beta*vh  +  Beta_c*vc)  +  CLA*(xcg- .25) ; 

CMIS  =  -Alpha. ih*vh  +  CLIS*(xcg-.25) ; 

CMIC  =  Alpha_ic*vc  +  CLIC*(xcg-.25) ; 

%  Compute  dynamic  stability  derivatives  needed 
'/•  for  linearization. 
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CLQ  =  57.3*(clift_wb_q_r*clift_wb_q_eor  +  ... 
clift_h_q_r*clift_h_q_eor*k2  -  clift_c_q_r* . . . . 
clift_c_q_eor*k2_c) ; 

CLAD  =  57.3*kl*(clift_wb_adf_r*clift_wb_adf_eor  +  ... 
clift_h_adf _e*k2  +  clift_c_adf _e*k2_c) ; 

CMQ  =  57.3*((dcm_dcl_wb_r  +  dcm_dcl_wb_er)* . . . . 

(clift _wb_q_r*clift_wb_q_eor)  +  cm_wb_q_r*cm_wb_q_eor  -... 
clift_h_q_r*clift_h_q_eor*vh 
clift_c_q_r*clift_c_q_eor*vc)  +CLq*(xcg-.25) ; 

CMAD  =  57.3*((dcm_dcl_wb_r  +  dcm_dcl_wb_er)* . . . . 
(cm_wb_adf_r*cm_wb_adf_eor)  . . . 

-  clift _h_adf_e*vh  -  clift_c_adf_e*vc)  +  CLAD*(xcg-.25) ; 

'/,  Compute  stability  derivatives  for  the 
'/,  generalized  elastic  coordinates.  When  these  are 
'/,  non-zero,  the  model  is  aeroelastic.  The  resulting 
%  model  is  termed  Ref  B  is  Chapter  2. 

[phi ,phidot]=modeshpe( .25*250) ; 

CLeta  =  CLA*phidot ; 

CLetad  =  CLA*phi/U; 

CMeta  =  CLA*(xcg- .25)*phidot ; 

CMetad  =  CLAD*phi*(xcg- .25)/U; 

QO  =  -CL0*phi; 

QA  =  -CLA*phi; 

qq  =  -CLq*phi; 

qETA  =  -CLA*phidot*phi; 

qETAD  «  -CLAD*phi*phi/U ; 

[phi ,phidot]=modeshpe(tloc*250) ; 
qiS  =  -CLIS*phi; 

[phi ,phidot]=modeshpe(cloc*250) ; 
qiC  =  -CLIC*phi; 

V,  Combine  the  individual  terms  into  a  vector 
*/»  to  be  returned. 

CL  =  [CLO  CLA  CLAD  CLq  CLeta  CLetad  CLIS  CLIC] ; 

CM  =  [CMO  CMA  CMAD  CMq  CMeta  CMetad  CMIS  CMIC] ; 

qF  =  [qo  qA  qq  qETA  qETAD  qis  qic] ; 
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APPENDIX  B.  RFTPS  SUPPORT 


1.  INTRODUCTION 

This  appendix  documents  the  C-code  unique  to  the  RFTPS  design  that  is  not 
automatically  generated  via  the  autocode  tools.  The  focus  is  on  the  serial  module, 
which  processes  both  the  IMU  and  GPS  data.  More  complete  hardware  descriptions 
of  the  I/O  modules  supported  by  the  AC100  architecture  can  be  found  in  the  AC100 
Model  C30  Supplemental  Reference  Manual.  Wiring  diagrams  and  pin  assignments 
are  on  file  in  the  Avionics  Lab. 


2.  SERIAL  MODULE 

The  serial  module  contains  two  multi-mode,  bi-directional,  channels.  The  user 
interface  to  the  device  is  through  the  file  «ser_ser.c.  Within  userser.c ,  three  functions 
must  be  defined.  The  first,  get _SERIAL_parameters,  is  used  to  initialize  the  channels. 
The  second,  user_SERIAL_out,  defines  the  output  from  each  channel  and  the  third, 
user_SERIAL_in,  processes  received  data  in  the  input  buffer.  Currently,  the  serial 
module  is  not  used  to  send  data.  Some  of  the  shell  in  userser.c  is  not  shown.  The 
documentation  focuses  on  RFTPS  specific  code  associated  with  processing  the  GPS 
and  IMU  data. 


/************************************************************ 
**  File  :  user.ser.c 

**  Project  :  RFTPS 
**  Edit  level  :  4 
** 

**  Abstract:  :  File  contains  functions  which  the  user 
**  must  define  to  interface  with  IP-SERIAL  device 
**  driver. 

**  The  functions  must  be  called 
** 

**  get_SERIAL_parameters 
**  user_sample_SERIAL_in 
**  user_SERIAL_out 
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** 

**  Templates  for  the  functions  are  provided. 

** 

**  get_SERIAL_parameters 

**  Function  sets  the  asynchronous  communication 
**  parameters  for  the  IP-SERIAL  module.  Ring  buffer 
**  sizes  used  to  store  received  data  must  also  be 
**  specified. 

** 

**  user_SERIAL_out 

**  Function  is  called  every  scheduler  interval.  The 
**  user  is  responsible  for  creating  a  byte  stream  from  the 
**  models  floating  point  outputs.  The  user  must  ensure 
**  that  the  when  writing  these  bytes  to  the  output  buffers 
**  that  the  buffers  are  not  overflown. 

** 

**  user_sample_SERIAL_in 

**  Function  is  called  every  sampling  interval.  The 
**  user  is  responsible  for  filling  the  floating-point 
**  vector  which  is  used  as  input  to  the  model  for 
**  the  current  sampling  interval. 

** 

**  Modifications: 


•T*  -T-  — 

** 

Creation 

7-1—93 

Henry  Tominaga 

** 

Revised 

8-23-93 

Brent  Roman 

** 

Revised 

11-18-93 

Steve  .Lynch 

** 

Revised 

9-1-94 

Steve  Lynch 

** 

Revised 

1-17-96 

Eric  Hallberg  [New 

IMU] 

** 

Revised 

3-15-96 

Eric  Hallberg  [IMU 

Serial  A 

** 

/  GPS 

Serial  B] 

** 

Revised  : 

:  5-01-96 

Eric  Hallberg  [IMU 

binary] 

*/ 


#include 
#include 
#include 
# include 
#include 
#include 
#include 


<stddef .h> 

<stdlib.h> 

"sa_types.h" 

"stdtypes.h" 

"actypes .h" 

"ioerrs .h" 

"errcodes.h" 
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#include  "iodefs.h" 

#include  "iodriver.h" 

#include  "ipserial.h" 

#include  "printx.h" 

#def ine  NULL  0 

/*  semaphores  and  serial  parameters  for  each 
physical  channel  */ 
private  struct 

{  ISI.BOOLEAN  allSent;  ISI.BOOLEAN  broken; 
unsigned  baud;}  line_state[2] ; 

struct  user.type 

{ 

int  update.interval; 
int  update_count ; 

>; 


typedef  struct  _bytes 

{ 

unsigned  bytel  :8; 
unsigned  byte2  :8; 
unsigned  byte3  :8; 
unsigned  byte4  :8; 

}_bytes; 

typedef  union  float_char 

float  fl; 

_bytes  ch; 

}  float_char; 

/*  global  variables  used  in  user_ser_in  ch  A 
IMU  data  processing  */ 

u_int  buff er_data[40] ; 
int  index; 
int  tick  =  0; 
int  first _frame_a  =  0; 
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float  last_float_a[14] ; 
float  last_f loat_a_l [14] 
float  last_f loat_a_2 [14] 
float  last_f loat_a_3 [14] 
int  missed.cr  =  0; 


/*  global  variables  used  in  user_ser_in  ch  B 
GPS  processing  */ 

int  first _frame_b  =  0; 

float  last_f loat_b[50] ,  sol=299792458.0,  llf0=1575420000.0,  k2; 
unsigned  long  icpoldl,  icpold2,  icpold3,  icpold4, 
icpold5,  icpold6; 
int  num_bytes_old=0; 

/*  Function:  get_SERIAL_parameters  +++++++++++++++++++++ 

**  Returns: 

**  NONE 
*/ 

public  void  get_SERIAL_parameters 

( 

unsigned  int  hardware.channel, 

volatile  struct  user_param  *device_param, 

volatile  struct  ring.buff er_param  *rec_buffer, 

IOdevice  *device) 

{ 

struct  user.type  *user_ptr; 
serial_param_tjrpe  *serptr; 

serptr  =  device->parameters; 

if  (SERIAL.USER.PTR  ==  NULL) 

{ 

SERIAL_USER_PTR  =  (void  *)malloc(sizeof (struct  user_type)); 
user_ptr  =  (struct  user_type  *)SERIAL_USER_PTR; 
user_ptr->update_interval  =  1000; 
user_ptr->update_count  =0; 

> 

/*  Both  IMU  and  GPS  sensors  send  their  data  at 
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9600  baud/RS-232  standard  */ 

if  (hardware.channel  ==  chanA  | |  hardware_channel  ==  chanB) 

{ 

/*  set  parameters  for  channel  A  (IP-SERIAL  channel  1)*/ 
device_param->parity  =  NONE; 

device_param->baud_rate  =  9600; 

device_param->stop_bits  =  ONE; 

device_param->transmit_data_size  =  8; 
device_param->receive_data_size  =  8; 
device_param->clock_multiplier  =  16; 

/*  Set  size  for  receive  ring  buffer. 

Here  it  is  set  to  lOx  the  message  size  */ 
rec_buff er->buff er_size  =  600; 

> 

else 

-c 

printx(" INVALID  CHANNEL\n") ; 

> 

}  /*  get_SERIAL_parameters  */ 


/*  Function:  user_SERIAL_out  +++++++++++++++++++++++ 
*/ 

public  RetCode  user_SERIAL_out (IOdevice  ^device, 
float  model_f loat  []  , 
u_int  ser_channel) 

-c 


Byte 

u_int 

f loat_char 
RetCode 


cbuffer[20]  ; 

i; 

data; 

return_val ; 


return_val  =  OK; 

/*******  *  ******  *  *  ****  **  **  *  **  *  **  *  *  *  *  *  *  *  *  *  *  *  *  *  *  *  * 

*  Given  floating  point  model  output, 

*  create  buffer  which  contains  bytes 

*  to  be  transmitted  across 

*  serial  channel . 

if  (numbytes_in_buffer(device->parameters)  ==  0) 
for  (i  =  0;  i  <  5;  i++) 
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{ 

data.fl  =  model.f loat [i]  ; 
cbuffer[0]  =(Byte)  data. ch.bytel ; 
cbuffer[l]  =(Byte)  data.ch.byte2; 
cbuffer[2]  =(Byte)  data.ch.byte3; 
cbuffer[3]  =(Byte)  data.ch.byte4; 

/ ************************************************** 

*  Fill  the  output  buffer  with  data  to  be  transmitted 

*  by  the  background  portion  of  the  serial  driver 

***************************************************/ 
return. val  =  write.serial (device->parameters ,cbuff er,4) ; 
if  (return.val  ==  -1) 

{ 

printx( "Error:  Buffer  overflow  in  User.ser  on 
output  to  serial\n"); 

> 

> 

> 

return  OK; 

>  /*  user_SERIAL_out  */ 

/*  Function:  user_sample_SERIAL_in  +++++++++++++++++ 

*/ 

public  RetCode  user_sample_SERIAL_in(IOdevice  *device, 
float  model.f loat  []  , 

u.int  ser.channel) 

{ 

/ **********readijjG  CHANNEL  A  ******  IMU  ********/ 
if  (ser_channel==chanA) 

/*  Create  a  software  buffer  to  hold  receive 
buffer  data  */ 
u_int  soft .buffer [600] ; 

/*  Declare  varibiables  needed  */ 
unsigned  char  item[l]; 
float  k; 
int  y,z,j; 
int  s  =  0; 
int  p  =  0; 
u.int  w.high; 
u.int  w.low; 
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struct  user_type  *user_ptr; 

/*  The  IMU  data  is  sent  as  twos  complement 
and  must  be  scaled*/ 

float  scale[]  =  {180/8191.0,  -2.0/8191.0, 

-2.0/8191.0,  -2.0/8191.0, 
200.0/8191.0,  200.0/8191.0, 

200.0/8191.0,  180.0/8191, 
180.0/8191.0,  10.0/8191.0, 

10.0/8191,  10.0/8191.0, 

10.0/8191.0,  10.0/8191.0}, 

default  _dat  a  []  =  {  10.0,  10.0,  -10.0,  10.0,  10.0,  10.0, 
10.0,  10.0,  10.0,  1.0,  1.0,  1.0,  1.0,  1.0}; 

/ ********************************************** 

*  set  user  pointer  to  buffer  allocated 

*  by  get  parameters 

*  this  buffer  is  passed  around  with  the 

*  structure  device 

*  and  should  only  be  accessed  via  the  SERIAL_USER_PTR 

* 

*********************************************  J 

user_ptr  =  SERIAL_USER_PTR; 

/*  The  first  time  the  serial  port  is  read; 

load  default  data  */ 
if  (f irst_f rame_a==0){ 
for  (j=0; j<14; j++){ 
last_f loat_a[j]  =  default_data[j]  ; 
last_f loat_a_l [j]  =  default_data[j] ; 
last_float_a_2[j]  =  def  ault_data[j]  ; 
last_float_a_3[j]  =  default_data[j] ; 

}/*  end  if*/ 

model_float  =  last_f loat_a; 
index  =  0; 
first _frame_a  =  1; 
return  OK; 

}/*  end  if*/ 

/*  Process  hardware  buffer  by  moving  data  into 


179 


the  software  buffer  */ 

while (  (numbytes_in_buffer(device->parameters))  >1  ){ 

read_serial(device->parameters , 1 , item) ; 
soft_buffer[s]=(u_int)  item[0]; 
s=s+l ; 

}  /*  end  while  */ 

/*  The  IMU  data  string  ends  with  a  carriage  return. 

Always  sync  on  the  carriage  return*/ 
while  (  p  <  (s)){ 
if  (soft_buffer[p]  ==  ,\r,){ 
missed_cr  =  1 ; 
index  =  0; 

}/*  end  if*/ 
else{ 

if  (missed.cr  ==  1){ 

buffer_data[  index  ]  =  soft .buffer  [p] ; 

}/*  end  if  */ 

index=index  +  1 ; 
if  (index  ==  30) { 
index  =  0; 
missed.cr  =  0; 

}/*end  if*/ 

}/*  end  else*/ 
p=p+l; 

}  /*  end  while  */ 

/*  Implement  some  rudimentary  error  detection  to  remove 

*  blatantly  bad  data  from  the  IMU.  Since  the  IMU  does  not 

*  send  a  check  sum,  use  multiple  buffers  to  compare  present 

*  with  past  values.  Remove  data  readings  that  are  not 

*  physically  possible.  Send  last  good  data.  */ 

tick  =  tick  +  1 ; 
if  (tick  ==  4) 
tick  =  1; 


if  (tick  ==  1) 

for  (  y=0 ;  y<14;  y++){ 
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/*  The  number  is  in  binary,  2’s  complement. 

Convert  to  decimal  and  scale  */ 
w_high  =  buffer_data[y*2]  ; 

w_low  =  buff er_data[y*2+l] ; 
k  =  128*(w_high  &  0x7F)  +  (w_low  &  0x7F) ; 

if  (k  >  8191) 
k  =  k  -  16384; 

last_float_a_l [y]  =  k*scale[y]; 

if  (abs (last_f loat_a_l [y]  -  last_float_a_3[y] )  <  .1) 
last_float_a[y]  =  last_f loat_a_l [y] ; 

}  /*  end  for  loop  */ 

}/*end  if*/ 

if  (tick  ==  2) 

for  (  y=0 ;  y<14;  y++){ 

w_high  =  buffer_data[y*2] ; 

w_low  =  buff er_data[y*2+l] ; 
k  =  128*(w_high  &  0x7F)  +  (w_low  &  0x7F) ; 

if  (k  >  8191) 
k  =  k  -  16384; 

last.f loat_a_2  [y]  =  k*scale[y] ; 

if  (abs (last _float_a_2[y]  -  last.f loat_a_l [y] )  <  .1) 
last_float_a[y]  =  last_float_a_2[y] ; 

}  /*  end  for  loop  */ 

}/*end  if*/ 

if  (tick  ==  3) 

{ 

for  (  y=0;  y<14;  y++){ 

w_high  =  buff er_data[y*2] ; 
w_low  =  buff er_data[y*2+l]  ; 
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k  =  128*(w_high  &  0x7F)  +  (w_low  &  Ox7F) ; 

if  (k  >  8191) 
k  =  k  -  16384; 

last_float_a_3 [y]  =  k*scale [y] ; 

if  (abs(last_float_a_3[y]  -  last_float_a_2 [y] )  <  .1) 
last_float_a[y]  =  last_float_a_3[y] ; 

}  /*  end  for  loop  */ 

}/*end  if*/ 

/*  Pass  the  IMU  data  back  up. 
for  (j=0; j<14;j++){ 
model.float [j]  =  last_float_a[j] ; 

}/*  end  for*/ 

}-/*  end  if  ch  a  */ 

/******  READING  CHANNEL  B****  GPS  ********/ 
if  (ser_channel==chanB){ 

unsigned  char  itemb[l],  msgl[600],  checksuml [1] , 
checksum2 [1] ,  mychecksuml ,mychecksum2 ,  status, 
model,  mode2,  mode3,  mode4,  mode5,  mode6, 
msg3[45],  checksum3[l] ,  mychecksum3,  msg4[62] , 
checksum4[l] ,  mychecksum4; 

struct  user.type  *user_ptr; 

unsigned  long  i,  j,  icpl,  icp2,  icp3, 
icp4,  icp5,  icp6, 
ephl,  eph2,  eph3,  eph4, 
eph5 ,  eph6 ; 

long  lat.  Ion,  vel,  heigps,  heimsl; 

int  numl,  num2,  num3,  satl,  sat2, 
sat3,  sat4,  sat5,  sat6, 
sattl,  satt2,  satt3,  satt4, 
satt5,  satt6,  num4. 
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velnor,  velup,  veleast; 


float  psrngl,  psrng2,  psrng3,  psrng4, 
psrng5,  psrng6,  psrngratel,  psrngrate2, 
psrngrate3,  psrngrate4,  psrngrate5, 
psrngrate6,  loctime,  sattimel , sattime2, 
sattime3,  sattime4,  sattime5,  sattime6, 
ecefx,  ecefy,  ecefz,  velnorl,  veleast 1, 
velupl,  hd,  timeref,  pscorl,  pscor2, 
pscor3,  pscor4,  pscor5,  pscor6, 
psrcorl,  psrcor2,  psrcor3,  psrcor4, 
psrcor5,  psrcor6,  locsec,  locsecf, 
satsecl,  satsec2,  satsec3,  satsec4, 
satsec5,  satsec6, satsecfl ,  satsecf2, 
satsecf3,  satsecf4,  satsecf5, 
satsecf6,  heigpsl,  heimsll, 
veil,  latl,  lonl,  ecefxl,  ecefyl,  ecefzl; 

/************  ********************************************** 

*  set  user  pointer  to  buffer  allocated  by  get  parameters  * 

*  this  buffer  is  passed  around  with  the  structure  device  * 

*  and  should  only  be  accessed  via  the  SERIAL_USER_PTR  * 

*  define  * 

***********************************************************/ 
user.ptr  =  SERIAL_USER_PTR ; 

y^****************************************************.^,,^,,.* 

*  set  user  pointer  to  buffer  allocated  by  get  parameters  * 

*  this  buffer  is  passed  around  with  the  structure  device  * 

*  and  should  only  be  accessed  via  the  SERIAL_USER_PTR  * 

*  define  * 

**********************************************************/ 

/*  If  first  time  read,  load  default  data  */ 
if (f irst_f rame_b==0) { 
f or (i=0 ; i<50 ; i++) { 
last_f loat_b [i] =7.0; 
f irst_frame_b=l; 

icpoldl=0.0;  icpold2=0.0;  icpold3=0.0;  icpold4=0.0; 
icpold5=0.0;  icpold6=0.0; 

}/*end  for*/ 
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}/*end  if*/ 


/*  The  message  is  61  bytes  long  and  comes  in  once  a  second. 
*  Wait  for  the  whole  message  to  come  in.  */ 
numl  =  (numbytes_in_buffer(device->parameters)) ; 
if  ((numl  >  60)  &  (numl  ==  num_bytes_old)  ){ 

f or (i=0 ; i<numl ; i++) { 

read_serial (device->parameters , 1 , itemb) ; 
msgl  [i]=itemb[0]  ; 

}/*  end  for  */ 

}/*end  if  message  in*/ 

/*  The  message  is  in  ASCII  Hex  and  starts  with  @@BA. 

Search  for  start  of  string.  */ 
for  (i=4;i<numl;i++){ 

if  (msgl [i— 43  == ' © J  &  msgl^-S]”'®’  & 
msgl [i-2]==,B’  &  msgl[i-l]==,a,  ){ 

checksuml [0]  =  msgl[i+61]; 

/♦Convert  message  bytes  to  decimal  numbers*/ 

lat  =  msgl [i+11] *0x1000000  +  msgl [i+12] *0x10000  + 
msgl [i+13] *0x100  +  msgl[i+14]; 

Ion  =  msgl [i+15] *0x1000000  +  msgl [i+16] *0x10000  + 
msgl [i+17] *0x100  +  msgl[i+18]; 

heigps  =msgl[i+19] *0x1000000  +msgl[i+20] *0x10000  + 
msgl [i+21] *0x100  +  msgl [i+22] ; 

heimsl  =  msgl [i+23] *0x1000000  +msgl [i+24] *0x10000  + 
msgl [i+25] *0x100  +msgl  [i+26] ; 

vel  =  msgl [i+27] *0x100  +  msgl[i+28]; 

hd  =  msgl [i+29] *0x100  +  msgl [30]; 

hd  =  hd/10.0; 
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status  =  msgl [i+60] ; 

vell=vel/100.0;  heigpsl=heigps/lOO . 0;  heimsll=heimsl/100 .0; 
latl«lat/100.0;  lonl=lon/100 .0; 

/♦GPS  uses  a  check  sum.  Check  if  message  is  correct*/ 
mychecksuml=  ’  B  ‘  ~  ’  a.’  ; 
f  or(j=0 ;  j<61 ;  j++){ 
mychecksuml~=msgl [i+j] ; 

>/*end  for*/ 

/*  If  its  correct,  update  GPS  data, 
if  (mychecksuml  ==  checksuml [0] ){ 

last_f loat_b [0] =lat 1 ; 
last_f loat_b [1] =lonl ; 
last_f loat_b [2]=heigpsl ; 
last_f loat_b [3] =heimsll ; 
last_f loat_b [4] =vell ; 
last _f loat_b [5] =hd ; 
last_f loat_b [6] =st atus ; 
last_f loat_b [7]=checksuml [0]  ; 
last_f loat_b [8] =mychecksuml ; 

}/*end  if  checksum  ok*/ 

i=i+60 ; 

}/*  end  if  @@Ba  */ 

/*  Pass  the  GPS  data  back  up  */ 

for  (j=0;j<8;j++){ 

model.float [j]  =  last_f loat_a[j] ; 

}/*  end  for*/ 

}/*  end  if  ch  b  */ 
return  OK; 

}  /*  user_sample_SERIAL_in  */ 
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